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veloped.  This  measure,  if  used  with  kinematic  control  methods,  helps  achieve 
dexterous  movements  including  singularity  avoidance.  Compared  to  other  mea¬ 
sures  such  as  the  manipuiability  measure  and  the  condition  number,  this  measure 
tends  to  give  superior  performances  in  terms  of  preserving  the  repeatability  prop¬ 
erty  and  providing  with  smoother  joint  velocity  trajectories. 

Using  the  fixed  transformation  property,  Taylor’s  Bounded  Deviation  Paths 
Algorithm  has  been  extended  to  the  redundant  manipulators. 


ANALYSIS  AND  CONTROL  OF  ROBOT  MANIPULATORS 
WITH  KINEMATIC  REDUNDANCY 


BY 

PYUNG  HUN  CHANG 

B.S.(1974)  Mechanical  Engineering 
Seoul  National  University,  Seoul,  Korea 
M.S.(1977)  Mechanical  Engineering 
Seoul  National  University,  Seoul,  Korea 

Submitted  to  the  Department  of  Mechanical  Engineering 
in  partial  fulfillment  of 
the  requirements  for  the  Degree  of 
Doctor  of  Philosophy  in  Mechanical  Engineering 

at  the 

Massachusetts  Institute  of  Technology 
May  1987 

©Massachusetts  Institute  of  Technology 


Signature  of  Author 


Department  of  Mechanical  Engineering 

May  12,  1987 


Certified  by _ 

Berthold  K.  P.  Horn 

Department  of  Electrical  Engineering  and  Computer  Science 

Thesis  Supervisor 


Accepted  by _ 

Ain  A.  Sonin,  Chairman 
Departmental  Graduate  Committee 
Department  of  Mechanical  Engineering 


Analysis  And  Control  Of  Robot  Manipulators 
With  Kinematic  Redundancy 

by 

PYUNG  HUN  CHANG 

Submitted  to  the  Department  of  Mechanical  Engineering 
on  May  1,  1987  in  partial  fulfillment  of 
the  requirements  for  the  Degree  of 
Doctor  of  Philosophy  in  Mechanical  Engineering 

ABSTRACT 

A  closed-form  solution  formula  for  the  kinematic  control  of  manipulators  with 
redundancy  is  derived,  using  the  Lagrangian  multiplier  method.  Differential 
relationship  equivalent  to  the  Resolved  Motion  Method  has  been  also  derived. 
The  proposed  method  is  proved  to  provide  with  the  exact  equilibrium  state  for 
the  Resolved  Motion  Method.  This  exactness  in  the  proposed  method  fixes  the 
repeatability  problem  in  the  Resolved  Motion  Method,  and  establishes  a  fixed 
transformation  from  workspace  to  the  joint  space.  Also  the  method,  owing  to  the 
exactness,  is  demonstrated  to  give  more  accurate  trajectories  than  the  Resolved 
Motion  Method. 

In  addition,  a  new  performance  measure  for  redundancy  control  has  been  de¬ 
veloped.  This  measure,  if  used  with  kinematic  control  methods,  helps  achieve 
dexterous  movements  including  singularity  avoidance.  Compared  to  other  mea¬ 
sures  such  as  the  manipulability  measure  and  the  condition  number,  this  measure 
tends  to  give  superior  performances  in  terms  of  preserving  the  repeatability  prop¬ 
erty  and  providing  with  smoot  her  joint  velocity  trajectories. 

Using  the  fixed  transformation  property,  Taylor’s  Bounded  Deviation  Paths 
Algorithm  has  been  extended  to  the  redundant  manipulators.  (  ^  £.')  4-  - — __ 

v 

Thesis  Supervisor:  Dr.  Berthold  Klaus  Paul  Horn 

Professor  of  Electrical  Engineering  and  Computer  Science 

Acknowledgment:  This  report  describes  research  done  at  the  Artificial  In¬ 
telligence  Laboratory  of  the  Massachusetts  Institute  of  Technology.  Support  for  the 
laboratory’s  artificial  intelligence  research  is  provided  in  part  by  the  Office  of  Naval 
Research  University  Research  Initiative  Program  under  Office  of  Naval  Research 
contract  N00014-86-K-0685.  in  part  by  the  Advanced  Research  Projects  Agency  of 
the  Department  of  Defense  under  Office  of  Naval  Research  contract  N00014-80-C- 
0505,  and  in  part  by  the  Systems  Development  Foundation. 


Acknowledgements 


Many  people  contributed  to  this  thesis.  I  will  attempt  to  recall  the  major 
contributions  here. 

My  advisor  Berthold  K.  P.  Horn  was  the  guiding  force  behind  the  thesis,  whom 
I  deeply  thank.  He  first  suggested  to  me  to  work  on  the  redundant  manipulators, 
provided  advices  on  the  direction  of  the  thesis,  and  then  helped  with  insights, 
encouraged,  and  generously  supported  me  throughout  my  thesis  work  at  the  MIT 
Artificial  Intelligence  Laboratory.  He  also  read  through  several  drafts  carefully, 
returning  valuable  comments. 

I  also  thank  the  other  members  of  my  committee:  Jean  J.  Slotine  and  Ken 
Salisbury.  Jean  has  been  helping  me  in  various  ways  for  several  years.  He  espe¬ 
cially  gave  me  some  important  insights  about  sliding  mode  control  techniques.  I 
also  appreciate  his  effort  and  understanding  as  the  chairman  of  the  committee, 
which  were  of  great  help  to  me.  I  would  like  to  thank  Ken  sincerely  for  his  help 
in  many  ways.  Out  of  a  genuine  interest  in  my  research,  he  gave  me  many  helpful 
suggestions  in  solving  some  of  the  problems  that  I  had  faced.  Above  all,  his  will¬ 
ingness  to  be  available  without  reservation,  together  with  friendliness,  has  been 
especially  consoling  and  encouraging  during  the  period  when  my  advisor  was  on 
sabbatical  leave. 

I  also  thank  Tomas  Lozano-Perez  for  his  excellent  teaching  through  the  course 
in  robot  manipulation.  Besides,  his  comments  and  suggestions  in  the  first  half  of 
my  thesis  were  valuable.  In  addition,  I  recall  with  thanks  the  kindness  and  favor 
Tomas  showed  to  me  on  some  occasions. 

I  would  like  to  thank  the  MIT  AI  Lab,  directed  by  Patrick  Winston,  for 
providing  the  excellent  environment,  abundant  resources,  and  generous  financial 
support,  which  made  this  thesis  work  much  easier.  Additional  thanks  go  to  Chae 


An  for  providing  me  various  helps  including  prayers;  Neil  Singer  for  helping  me 
in  computation  problems  including  advices  on  plottings. 

Members  of  the  Gate  Bible  Study  at  MIT  have  supported  me  by  their  loving 
care  and  prayer.  My  parents  and  parents-in-law  have  supported  me  and  encour¬ 
aged  me  throughout  the  seven  years  at  MIT.  Now,  I  cannot  recall  my  two  great 
sons,  Chai  and  Jun,  without  appreciating  and  being  proud  of  what  they  have 
been  and  done  to  me:  so  disciplined  and  mature  for  their  ages. 

Finally  I  can  never  thank  enough  my  wife,  Minja,  who  has  demonstrated  her 
love  by  supporting  me  both  spiritually  and  emotionally,  with  such  remarkable 
patience  and  sensitivity. 


Contents 


1  Introduction  7 

1.1  Background  Study .  8 

1.1.1  Inverse  Kinematics  For  Trajectory  Control .  8 

1.1.2  Kinematically  Redundant  Manipulators .  11 

1.1.3  Performance  Measure  For  Singularity  Avoidance .  14 

1.2  Objectives .  18 

1.3  Overview  of  the  Thesis .  19 

2  The  Proposed  Method  for  the  Kinematic  Control  21 

2.1  Introduction .  21 

2.2  Derivation  of  the  Proposed  Equation  .  22 

2.3  Characteristics .  26 

2.4  Computational  Consideration .  28 

2.4.1  Motion  strategy  .  29 

2.4.2  Computational  Effort  at  Each  Iteration  Step  .  30 

2.4.3  Number  of  Iterations .  31 

2.4.4  Minimum  Number  of  Via  Points .  32 

2.5  Comparison  with  Other  Methods .  33 

2.5.1  Relationship  with  Luh’s  Expression .  34 

2.5.2  Relationship  with  Extended  Jacobian  Method .  34 

2.6  Conclusion  .  35 

3  Relationship  with  Resolved  Motion  Method  37 

3.1  Introduction .  37 

3.2  Resolved  Motion  Method  .  38 

3.2.1  The  Method  and  Its  characteristics .  38 

3.2.2  Repeatability  Problem .  40 

3.3  Relationship  between  the  Two  Methods .  41 

3.3.1  Equilibrium  State  .  42 

3.3.2  Differential  Relationship .  43 

3.3.3  Summary .  44 


3.-4  Computational  Consideration .  45 

3.4.1  Obtaining  equilibrium  States .  45 

3.4.2  Obtaining  Joint  Velocity .  47 

3.5  Conclusion  .  48 

4  Numerical  Experiment  on  Kinematic  Control  Methods  50 

4.1  Introduction .  50 

4.2  System  Description .  51 

4.3  Procedures  .  53 

4.4  Results .  55 

4.5  Discussions .  63 

5  Development  of  A  Dexterity  Measure  68 

5.1  Introduction .  68 

5.2  Review  of  Singularity  and  Redundancy .  70 

5.2.1  Singularity .  70 

5.2.2  Kinematic  Redundancy .  72 

5.3  A  New  Concept  of  Distance  from  Singularity  in  Redundant  Case  .  73 

5.4  The  Derivation  of  A  New  Performance  Measure .  77 

5.5  The  Property  of  The  Measure .  78 

5.6  Conclusion  .  79 

6  Relationship  and  Comparison  with  other  Measures  82 

6.1  Introduction .  82 

6.2  Relationship  with  Other  measures  .  83 

6.2.1  the  relationship  to  the  manipulability  measure .  83 

6.2.2  Relationship  with  the  condition  number .  85 

6.3  Comparison  of  Performance  measures  .  87 

6.3.1  Overcoming  singularity  .  88 

6.3.2  Preserving  the  aspect  and  its  effect  to  the  repeatability 

problem .  95 

6.3.3  Discontinuity  effects .  99 

6.4  Conclusion  . 100 

7  Conclusion  112 

Appendices  115 

Appendix  1:  Taylor's  Algorithm  . 115 

Appendix  2:  The  Derivation  of  The  Extended  Jacobian  Method . 116 

Appendix  3:  Equilibrium  State  Relationship . 117 

Appendix  4:  Proof  of  Theorem . 119 


Chapter  1 
Introduction 


The  kinematic  control  of  kinematically  redundant  manipulators  has  become  an 
important  subject  of  study,  owing  to  the  growing  interests  in  redundant  robot 
manipulators.  Unfortunately,  most  of  the  existing  control  algorithms  are  in  a 
differential  form  based  on  the  pseudoinverse  matrix,  subject  to  usual  problems 
resulting  from  linearization.  The  algorithms  that  instead  use  a  direct  mapping, 
are  not  compact  and  closed-form,  and  not  applicable  to  all  manipulators.  Fur¬ 
thermore,  little  is  known  about  the  relationship  between  direct  mapping  methods 
and  the  differential  approach  for  redundant  manipulators.  One  motivation  of  this 
thesis  is  the  desire  to  develop  such  a  compact  yet  general  formula  that  enables 
direct  mapping,  and  to  understand  the  relationship  between  this  formula  and 
algorithms  in  differential  form. 

Another  motivation  comes  from  the  observation  that  the  degree  of  redundancy 
cannot  sufficiently  describe  how  far  a  manipulator  is  from  singularity.  In  other 
words,  with  the  same  degree  of  redundancy,  there  are  relatively  different  degrees 
of  distance  from  singularity.  Surprisingly,  little  research,  to  our  knowledge,  has 
dealt  with  this  fact.  Hence,  to  develop  a  satisfactory  concept  of  relative  degrees 
of  redundancy  is  another  major  purpose.  Then,  from  this  concept,  we  derive 
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a  practical  performance  measure  that  can  be  used  for  singularity  avoidance  or 
dexterity  achievement  in  the  redundant  manipulators. 

The  introduction  is  organized  as  follows.  In  Section  1.1,  we  present  the  back¬ 
ground  of  the  motivations  mentioned  above.  In  Section  1.2,  then,  we  define  the 
problems  and  objectives  of  this  thesis.  Finally,  in  Section  1.3,  we  present  the 
overview  of  the  organization  of  this  thesis. 


1.1  Background  Study 


1.1.1  Inverse  Kinematics  For  Trajectory  Control 


Manipulator  Kinematics 


Manipulator  kinematics  is  a  study  of  manipulator  arm  motions,  from  which  one 
finds  the  relationship  between  the  movement  in  the  workspace  and  the  movement 
in  the  joint  space.  As  illustrated  in  Figure  1. 1,  the  importance  of  kinematics  in 


Inverse 

Kine-  —hW  ' 
matics  '  ^ 


X  Robot  o  Forward  x 

— *  Manipu - r*  Kine-  — 

lator  matics 


Figure  1.1:  The  Schematic  Diagram  Of  The  Manipulator  System. 


manipulator  trajectory  control  is  clear.  It  is  in  workspace  coordinates  that  specific 
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tasks  we  desire  are  usually  expressed;  whereas  it  is  in  the  joint  coordinates  that 
the  actuator  movements  are  described.  Therefore,  kinematics  is  a  fundamental 
tool  directly  connected  to  the  performance  in  manipulator  trajectory  control. 

Forward  Kinematics  and  Inverse  Kinematics 

Manipulator  kinematics,  hence,  includes  two  important  problems.  One  is  to  find 
the  location*  of  the  manipulator  in  workspace  coordinates  from  its  joint  coor¬ 
dinates  and  the  other  is  to  find  the  joint  coordinates  from  the  location  in  the 
workspace  coordinates.  The  former  is  called  the  forward  kinematic  problem ;  the 
latter,  being  the  inverse  problem,  is  called  the  inverse  kinematic  problem. 

Of  the  two  problems,  the  forward  kinematic  problem  is  the  simpler  one  since 
a  set  of  joint  coordinates  unambiguously  determines  a  unique  location  in  the 
workspace.  Furthermore,  the  solution  can  usually  be  expressed  in  a  symbolic 
form,  which  can  be  easily  evaluated  given  a  set  of  joint  coordinates  (Paul, 1981). 
The  inverse  kinematic  problem,  on  the  other  hand,  is  more  complicated  because, 
given  a  location  in  the  workspace,  there  are  multiple  sets  of  corresponding  joint 
coordinates.  More  importantly,  there  do  not  exist,  in  general,  closed-form  solu¬ 
tions,  except  for  some  kinematic  structures  of  manipulators.  Pieper(l968),  by 
the  way,  presented  the  criteria  that  guarantee  the  existence  of  a  closed-form  solu¬ 
tion.  Thus,  if  a  manipulator  structure  does  not  belong  to  this  category,  one  has 
to  find  solutions  by  numerical  methods,  typically  iterative  ones. 

Resolved  Motion  Method  and  Inverse  Kinematic  Method  for  Non- 
Redundant  Manipulators 

To  numerically  solve  the  inverse  kinematic  problem,  there  are  two  approaches:  one 
that  uses  the  linear  relationship  between  the  differential  joint  displacement  and 

‘location  consists  of  position  and  orientation. 
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differential  end  effector  displacement;  and  one  that  uses  the  direct  mapping  from 
workspace  to  joint  space.  The  former,  originally  proposed  by  Whitney(l969,1972) 
and  subsequently  used  by(Paul,1981;  Featherstone,1983),  is  called  the  Resolved 
Motion  Method ;  while  the  latter,  investigated  by  (Albala,1979;  Konstantinov  et 
al,1982;  Gupta  et  al,1985;  Goldenberg  et  at, 1985;  Angeles, 1985;  Wampler, 1986), 


is  simply  called  the  Inverse  Kinematic  Method. 

More  specifically,  the  Resolved  Motion  Method  first  differentiates  the  desired 


trajectory  of  the  end  effector  to  obtain  velocity.  Then,  this  Cartesian  velocity  is 
mapped  into  the  joint  velocity,  using  the  inverse  of  the  Jacobian  matrix.  Finally, 
the  joint  velocity  is  integrated  to  determine  the  joint  displacement. 

The  iterative  Inverse  Kinematic  Method,  on  the  other  hand,  directly  solves 


the  nonlinear  kinematic  equations,  without  linearizing  them,  for  a  given  location 
in  workspace.  Note,  however,  that  the  updating  process  at  each  iteration  step  of 
a  numerical  method  for  solving  the  nonlinear  kinematic  equations  can  be  viewed 


as  an  incremental  process  like  the  Resolved  Motion  Method.  With  this  view, 
then,  the  essential  difference  between  the  two  approaches  may  be  considered  the 


number  of  iterations:  The  Resolved  Motion  Method  can  be  considered  a  one 


iteration  Inverse  Kinematic  Method  without  any  built-in  convergence  criteria. 


Comparison  of  the  two  methods 


The  Resolved  Motion  Method,  thus,  has  some  weak  points: 


•  The  method  has  intrinsic  inaccuracy  because  of  the  linear  approximation 
characteristics  of  the  Jacobian  matrix;  thus  it  accumulates  errors,  which 


become  larger  as  the  velocity  increases. 


•  The  method,  being  a  rate  equation,  is  not  self-starting:  given  a  location  of 
the  end  effector,  corresponding  joint  values  cannot  be  determined  without 


using  other  methods. 


The  Inverse  Kinematic  Method  without  closed-form  solution,  on  the  other 
hand,  usually  requires  more  computational  effort  than  the  other  method.  So 
this  method  is  not  efficient  when  high  accuracy  is  not  needed.  Even  when  high 
accuracy  is  required,  in  order  to  be  practical  for  the  real-time  control  purpose, 
the  method  may  need  some  additional  numerical  schemes  such  as  interpolations 
between  knot  points  (Paul, 1975;  Paul, 1979;  Taylor, 1979).  Moreover,  for  some 
applications  that  require  to  resolve  joint  velocity  and  acceleration  as  well,  it  has 
an  intrinsic  disadvantage.  Yet,  the  Inverse  Kinematic  Method  is  still  attractive 
because  of  the  direct  mapping  from  the  workspace  to  joint  space,  fixing  the  afore¬ 
mentioned  problems  of  the  other  method. 

1.1.2  Kinematically  Redundant  Manipulators 

Kinematic  Redundancy 

A  kinematically  redundant  robot  manipulator  is  a  manipulator  that  has  more 
degrees  of  freedom  than  necessary  to  place  the  end  effector  at  a  desired  location. 
For  example,  if  we  want  to  place  the  end  effector  in  a  three  dimensional-space, 
we  need  six  degrees  of  freedom:  three  for  translation  and  three  for  orientation. 
Thus,  a  robot  manipulator  with  more  than  six  degrees  of  freedom  is  kinematically 
redundant  in  the  three-dimensional  space. 

Use  of  Redundancy 

The  major  advantages  of  adding  redundant  degrees  of  freedom  to  a  robot  manip¬ 
ulator  are  as  follows: 

1.  One  achieves  greater  dexterity  in  maneuvering  in  a  workspace  with  obsta¬ 
cles. 

2.  One  can  avoid  singular  configurations  of  the  manipulators. 


Because  of  these  significant  advantages,  an  increasing  amount  of  research  has  fo¬ 
cused  on  the  kinematically  redundant  manipulator,  and  the  progress  in  this  field 
has  been  rapid.  More  specifically,  to  avoid  obstacles,  several  researcher  such  as 
(Yoshikawa.1984;  Maciejewski,1985;  Espiau,1985;  Nakamura, 1985;  Baillieul,1986) 
have  used  the  kinematical  redundancy.  Meanwhile  the  effort  to  avoid  singular¬ 
ity  through  the  use  of  redundant  manipulators  is  found  in  the  works  by  (Whit¬ 
ney, 1972;  Yoshikawa,1984;  Hollerbach,  1985, Baiilieul, 1985;  Luh  et  al,1985;  Naka¬ 
mura, 1985a).  Besides,  the  use  of  the  kinematic  redundancy  has  been  proposed  for 
constraining  the  joint  variables  within  their  physical  limits  (Liegeois,1977),  or  for 
minimizing  joint  torques  (Hollerbach, 1985),  or  for  minimizing  the  kinetic  energy 
due  to  joint  velocity  (Whitney, 1972). 

Redundancy  control 

Mathematically,  the  inverse  kinematic  problems  of  redundant  manipulators  are 
under-determined  problems:  more  variables  (joint  variables)  than  constraints(kinematic 
equations).  In  order  to  solve  equations  we  need  to  impose  extra  constraints. 
These  additional  constraints  sometimes  tend  to  be  imposed  out  of  necessity  to 
fully  specify  the  under-determined  condition;  or  sometimes  are  used,  on  purpose, 
to  achieve  additional  performances  objectives  as  mentioned  above.  The  former 
tendency  was  shown  in  (Whitney, 1972),  where  the  joint  velocity  was  obtained  by 
using  the  pseudoinverse  of  the  Jacobian  matrix  to  resolve  the  under-determined 
joint  velocities. 

The  latter  case,  active  use  of  redundancy  called  the  redundancy  control,  was 
first  proposed  by  Liegeois  (Liegeois,1977).  He  used,  in  addition  to  the  same  pseu¬ 
doinverse  term  as  above,  the  null  space  term,  where  he  included  the  gradient 
vector  of  a  scalar  function  that  represents  the  desired  performance.  This  gradi¬ 
ent  vector  by  the  way,  if  used  with  the  null  space  of  the  Jacobian  matrix,  forces 


the  joints  to  move  toward  the  direction  where  the  scalar  function  has  the  op¬ 
timal  value  at  that  instant.  This  formulation  of  solution,  owing  to  the  ease  of 
including  the  desired  performance,  has  been  rather  extensively  used  to  achieve 
various  performances  as  mentioned  above  (Klein  and  Huang, 1983;  Maciejewski 
and  Klein, 1985;  Nakamura, 1985a;  Hollerbach  and  Suh,1986). 

Resolved  Motion  Method  and  Inverse  Kinematic  Method 

In  much  of  the  research  just  mentioned  —  regardless  of  whether  the  null  space  is 
actively  used  or  not,  or  regardless  of  which  performance  is  desired  —  the  motion 
is  resolved  in  the  differential  form.  More  specifically,  the  differential  displacement 
(or  velocity)  of  the  end  effector  is  mapped  into  the  differential  joint  displace¬ 
ment  (or  velocity)  now  by  using  the  pseudoinverse  of  the  Jacobian  matrix,  and 
then  incrementally  determines  the  joint  displacement.  This  technique,  thus,  is 
essentially  the  same  as  the  Resolved  Motion  Method  in  the  nonredundant  case; 
the  only  difference  is  that  the  pseudoinverse  is  used  instead  of  the  inverse  of  the 
Jacobian  matrix.2 

In  contrast  to  this  direction  of  research,  relatively  little  research  for  kine¬ 
matically  redundant  manipulators,  e.g.,  (Benati  et  al,1982;  Hollerbach, 1985;  Oh 
et  al,1984;  Benhabib  et  at, 1984, 1985)  has  involved  the  direct  mapping  —  the 
counterpart  of  the  Inverse  Kinematic  Method  in  the  nonredundant  case.  In  the 
redundant  case  too,  there  exist  in  general  no  closed-form  solutions;  only  if  cer¬ 
tain  conditions  are  met  by  the  manipulator  structure,  then  a  part  of  solution  is 
given.  For  example,  in  (Benati  et  al,1982,  Hollerbach,  1985)  only  some  of  the 
joint  variables  were  obtained  symbolically.  To  obtain  these  solutions  the  manip¬ 
ulator  structure  and  the  number  of  degrees  of  freedom  were  fixed,  explicitly  in 
(Hollerbach, 1985)  and  implicitly  in  (Benati, 1982). 

J  Hence  we  will  call  this  resolution  technique  the  Resolved  Motion  Method,  too. 


Comparison  of  the  two  methods  in  the  redundant  case 

Of  the  two  methods,  the  Resolved  Motion  Method  and  the  Inverse  Kinematic 
Method,  the  advantages(and  disadvantages)  of  the  one  method  over  the  other  in 
the  nonredundant  case  were  compared  in  the  previous  subsection.  The  comparison 
still  holds  in  the  redundant  case,  since  each  of  the  methods  is  essentially  the  same 
as  its  counterpart  in  the  nonredundant  case. 

In  addition,  another  significant  drawback  in  the  Resolved  Motion  Method  was 
pointed  out  in  (Klein, 1983):  the  lack  of  repeatability,  the  ability  to  repeat  the 
same  joint  values  for  repeated  end  effector  motion.  This  problem,  however,  does 
not  occur  when  direct  mapping  is  used. 

Meanwhile,  an  additional  difficult  task  for  Inverse  Kinematic  Method,  on  the 
other  hand,  is  to  rationally  (or  optimally)  use  the  extra  degrees  of  freedom  when 
achieving  the  additional  objectives.  Often,  this  optimization  procedure  being 
rather  complicated,  the  overall  inverse  kinematic  process  results  in  a  series  of 
iterative  procedures.  This  time,  the  shortcoming  is  not  so  serious  in  the  Resolved 
Motion  Method,  because  of  the  simple  null  space  expression. 

Therefore,  the  comparison  clearly  shows  that  one  method  is  complementary 
to  the  other,  indicating  one  desired  direction  in  which  a  kinematic  control  formula 
should  be  developed:  a  formula  that  provides  with  the  direct  mapping,  and  that 
is  as  concise  and  general  as  the  Resolved  Motion  Method. 

1.1.3  Performance  Measure  For  Singularity  Avoidance 

Using  a  quantitative  measure  that  represents  the  desired  performance  is  a  ben¬ 
eficial  method  for  the  analysis,  design,  and  control  of  engineering  systems,  as 
follows: 


•  one  can  evaluate  the  performance  of  a  given  system  and  analyze  the  system, 
by  estimating  this  measure;  or 

•  one  can  design  a  system  that  achieves  the  performance  in  a  certain  degree, 
by  maximizing(or  minimizing)  this  measure;  or 

•  one  can  control,  on  the  on-line  basis,  a  given  system  to  achieve  it,  by  max¬ 
imizing  the  measure  at  each  moment, 

without  having  to  rely  solely  on  experience  and  intuition. 

In  the  robotic  system,  also,  various  performance  measures  have  been  incorpo¬ 
rated  to  quantify  desired  performance  features  listed  in  the  previous  subsection. 

Dexterity  measure 

One  of  these  performances  was  the  ability  to  avoid  singularity,  or  in  a  broader 
sense  the  ability  to  dexterously  move  the  end  effector  to  an  arbitrary  location 
within  the  workspace,  without  getting  into  singular  configurations.  To  quan¬ 
titatively  represent  the  ability,  which  may  be  called  dexterity,  several  perfor¬ 
mance  measures  have  been  proposed  (Yoshikawa,1985a,1985b;  Uchiyama,1985; 
Maciejewski,I985;  Salisbury;  1982).  These  measures  are  the  determinant,  the 
condition  number,  and  a  few  combinations  of  singular  values,  of  the  Jacobian 
matrix  J  —  through  which,  by  the  way,  the  end  effector  movement  is  achieved. 
Determinant 

In  linear  algebra,  the  determinant  of  a  matrix  has  been  an  important  measure 
used  to  test  the  invertibility  of  the  matrix  and  its  nearness  to  singularity.  Ac¬ 
cordingly  the  determinant  of  the  Jacobian  matrix  has  been  tried  for  the  dexterity 
measure  for  both  nonredundant  and  redundant  manipulators.  For  nonredundant 
manipulators,  for  instance,  the  determinant  has  been  used  as  a  measure  of  de¬ 
generacy  for  the  analysis  of  the  wrist  configurations(Paul  and  Stevenson,  1983). 


For  redundant  manipulators,  on  the  other  hand,  Yoshikawa(1984)  has  proposed 
a  measure  called  manipulability  defined  as  the  square  root  of  the  determinant  of 
JJr.  Th  is  measure  is  viewed  as  a  generalized  concept  of  the  determinant,  because 
of  the  followings: 

•  the  manipulability  reduces  to  the  regular  determinant  in  the  nonredundant 
case. 

•  the  manipulability  become  zero,  when  workspace  rank  reduces  at  singularity, 
just  as  the  regular  determinant  of  a  square  Jacobian  matrix  does. 

•  since  the  singular  values  of  JJT  have  the  square  values  of  those  of  J,  the 
determinant  of  JJT  may  be  regarded  as  if  it  were  the  square  of  the  regular 
determinant  of  a  square  Jacobian  matrix. 

Condition  number 

Meanwhile,  since  the  condition  number  of  the  Jacobian  matrix  is  another  im¬ 
portant  measure  that  also  indicates  the  nearness  of  a  matrix  to  singularity,  it 
has  been  proposed  for  a  dexterity  measure(Salisbury,1982).  It  is  noteworthy  that 
this  measure  was  initially  used  to  determine  the  configuration  that  minimizes  the 
propagation  from  the  torque  error  to  the  force  error  —  equivalently,  the  velocity 
error  propagation  from  joint  space  to  workspace  —  for  nonredundant  manipula- 


Singular  values 

The  determinant  and  the  condition  number  can  be  also  expressed  in  terms  of  sin¬ 
gular  values  of  the  Jacobian  matrix:  the  former  is  the  product  of  all  the  singular 
values,  the  latter  the  ratio  of  the  largest  to  the  smallest  singular  value.  Since 
the  minimum  singular  value  becomes  zero  when  the  matrix  is  singular,  and  ap¬ 
proximately  determines  the  worst  limits  of  the  two  measures,  the  value  itself  was 
suggested  as  a  new  measure(Klein,1985).  In  addition  to  its  simple  expression, 
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the  measure  has  a  relatively  clear  physical  meaning:  it  may  be  interpreted  as 
the  minimum  responsiveness  in  end  effector  velocity  due  to  a  unit  change  in  joint 
velocity  (Klein, 1985). 

Besides,  the  geometric  mean  and  harmonic  mean  of  singular  values  have  been 
proposed  for  the  dexterity  measures (Yoshikawa,  1985b),  which  may  be  viewed  es¬ 
sentially  as  variations  of  aforementioned  measures. 

Common  features 

The  features  common  to  all  these  measures  are  as  the  following: 

•  They  indicate  the  presence  of  singularity:  when  singular,  the  value  of  these 
measures  become  zero,  except  for  the  condition  number,  the  value  of  which 
becomes  infinity. 

•  Their  absolute  values  —  inverse  of  the  value  in  the  case  of  the  condition 
number  —  appear  to  represent,  in  one  way  or  another,  the  farness  or  dis¬ 
tance  from  singularity.  That  is,  the  larger  the  value,  the  farther  is  the 
manipulator  from  a  singularity. 

In  the  case  of  redundant  manipulators,  however,  these  measures  do  not  ex¬ 
plicitly  indicate  the  successive  changes  in  the  available  degrees  of  freedom  as  long 
as  the  workspace  rank  is  preserved.  For  instance,  suppose  we  have  a  five  d.o.f. 
manipulator  which  is  to  move  in  a  three-dimensional  workspace,  hence  having 
two  degrees  of  redundancy.  Although  the  manipulator  happens  to  lose  one  degree 
of  freedom,  or  even  two,  the  measures  do  not  necessarily  indicate  that  fact. 

Problems  when  losing  d.o.f. 

Losing  degrees  of  freedom  may  not  in  itself  be  a  serious  drawback,  as  long  as 
the  workspace  rank  is  fully  preserved  so  that  the  desired  location  of  the  end 
effector  can  be  achieved  by  joint  variables.  Yet,  what  may  be  of  more  concerns 
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are  potential  problems  that  are  expected  to  arise  —  from  the  similar  experience 
in  the  nonredundant  case  —  when  degrees  of  freedom  are  lost.  More  specifically 
speaking,  in  the  nonredundant  case,  the  point  where  the  degrees  of  freedom  are 
lost  —  namely  the  singular  point  —  is  in  fact  the  boundary  of  switching  from  one 
set  of  joint  solution  to  another  (Uchiyama,1979).  Once  that  switching  happens, 
the  manipulator  tends  to  stay  in  the  new  kind  of  joint  configuration  different 
from  the  previous  kind,  thus  causing  another  pattern  of  repeatability  prob'em. 
Besides,  when  the  switching  arises,  usually  there  are  accompanying  discontinuity 
in  motion,  resulting  in  large  joint  velocities.  The  same  problems  are  expected 
in  the  redundant  case,  since  in  this  case  too  there  exist  multiple  solutions  of 
different  kinds  (Borrel,1986)  whose  boundaries  are  the  points  where  the  degree  of 
'"eedom  decreases,  ft  appears,  however,  that  these  nontrivial  problems  tend  to  be 
veiled  because  of  the  fact  that  owing  to  the  redundancy  the  switching  can  happen 
without  causing  the  more  serious  problem,  singularity.  To  our  knowledge,  there 
have  not  appeared  any  analysis  on  these  problems  for  redundant  manipulators, 
and  any  performance  measures  that  are  intended  to  prevent  them. 

1.2  Objectives 

The  objective  of  this  thesis,  broadly  speaking,  is  to  study  trajectory  control  of 
kinematically  redundant  manipulators,  focusing  on  the  kinematic  problems  men¬ 
tioned  in  the  first  subsection. 

To  this  end  there  are  two  major  goals.  The  first  goal  is  to  develop  a  general 
closed-form  method  for  the  inverse  kinematics  of  manipulators  with  kinematic 
redundancy.  This  method  is  similar  to  the  formulation  of  the  Resolved  Motion 
method,  in  actively  using  kinematic  redundancy;  but  it  is  different  in  choosing 
direct  mapping  from  the  workspace  to  joint  space.  Under  the  first  goal,  however, 


to  understand  the  relationship  between  the  inverse  kinematic  method  and  resolved 
motion  method  is  another  intended  purpose. 

The  second  goal  is  to  analyze  the  aforementioned  relative  distance  of  redun¬ 
dant  manipulators,  and  to  derive  from  this  analysis  a  performance  measure  that 
represents  the  dexterity  of  manipulator  including  singularity  overcoming.  This 
performance  measure  is  intended  to  be  used  either  with  on-line  kinematic  control 
methods  including  the  one  developed  from  the  first  goal,  or  for  off-line  design 
purposes.  Besides,  the  relationship  between  the  resulting  measure  and  already 
existing  measures  is  to  be  examined. 

1.3  Overview  of  the  Thesis 

In  Chapter  2,  a  closed-form  formula  for  inverse  kinematics  of  kinematically  re¬ 
dundant  manipulators  is  to  be  derived  using  the  Lagrangian  multiplier  method. 
This  formula  consists  of  a  set  of  equations  which,  if  added  to  the  kinematic  equa¬ 
tions,  fully  constrain  the  initially  under-determined  problem.  The  mathematical 
meaning  and  applications  of  the  formula  are  examined.  Then  the  relationship 
between  the  formula  and  already  existing  similar  methods  is  investigated. 

In  Chapter  3,  the  qualitative  relationship  between  the  new  method  and  the 
Resolved  Motion  Method  is  examined.  Then  in  the  light  of  the  relationship,  the 
repeatability  problem  is  focused  on. 

In  Chapter  4,  the  qualitative  results  obtained  in  Chapters  2  and  3  are  verified 
through  numerical  experiments.  Finally  numerical  efficiencies  of  the  two  methods 
are  compared. 

In  Chapter  5,  we  propose  a  new  concept  representing  the  distance  from  sin¬ 
gularity  for  kinematically  redundant  case.  This  concept  is  obtained  by  observing 
the  structure  of  the  Jacobian  matrix  of  redundant  manipulators.  Then,  by  using 


the  concept,  we  derive  a  new  dexterity  measure  that  can  be  used  with  either  the 
the  formula  obtained  in  Chapter  2  or  the  Resolved  Motion  Method. 


In  Chapter  6,  the  new  performance  measure  is  compared  with  two  existing 


performance  measures:  the  manipulability  measure  and  the  condition  number. 


After  their  qualitative  relationships  are  examined,  the  numerical  experiments  are 


made  with  redundant  manipulators  to  compare  the  effectiveness  of  each  measure 


in  achieving  dexterous  movements.  In  the  comparison,  at  the  same  time,  the 


repeatability  problem,  as  well  as  the  ability  to  preserve  the  kind  of  joint  solutions 


are  to  be  observed. 


Finally,  in  Chapter  7,  concluding  remarks  are  to  be  made. 


Chapter  2 

The  Proposed  Method  for  the 
Kinematic  Control 

|  - 
i 

i 

i 

2.1  Introduction 

In  this  chapter,  we  derive  a  general  closed-form  formula  for  the  kinematic  control 
of  redundant  manipulators  by  using  the  Lagrangian  multiplier  method.  This 
formula,  more  specifically  speaking,  consists  of  an  additional  set  of  constraints 
beside  the  kinematic  equation. 

The  key  features  of  this  formula,  beside  its  conciseness,  are  that  it  can  contain 
the  performance  measure  as  easily  and  generally  as  the  Resolved  Motion  Method 
with  null  space  can  (Liegeois,1977);  and  at  the  same  time  it  is  an  inverse  kine¬ 
matic  method.  Among  inverse  kinematic  methods  for  redundant  manipulators, 
we  find  similar  approaches  that  use  performance  measures;  but  they  lack  some 
of  the  features  this  formula  has.  Benati  et  al  (Benati,1982)  suggested  a  method 
using  a  general  quadratic  performance  measure  to  be  optimized,  the  resulting 
control  algorithm  of  which  is  quite  complicated  because  of  including  the  measure. 
Benhabib  et  al  (Benhabib,  1984, 1985)  also  used  performance  measures  to  achieve 
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additional  performances.  These  measures  are  optimized  with  a  searching  algo¬ 
rithm  under  constraints  on  joint  variables.  The  resulting  algorithm  becomes  also 
complicated.1 

Rather,  among  the  approaches  using  the  Resolved  motion  method,  we  find 
additional  constraints  in  similarly  concise  forms,  which  could  be  also  used  in  the 
inverse  kinematic  method.  Baillieul(Baillieul,1985),  in  the  process  of  deriving  a 
rate  equation  called  the  extended  Jacobian  Method ,  obtained  null  space  expres¬ 
sions  similar  to  the  formula  proposed  here.  Luh  and  Gu(Luh,1985)  proposed 
another  expression  of  the  null  space  in  a  generic  form.  We  will  investigate  more 
in  detail  about  the  relationship  between  the  proposed  formula  and  these  methods. 

After  deriving  the  formula  in  Section  2.2,  we  will  examine  in  Section  2.3  its 
mathematical  meaning  and  characteristics,  as  well  as  computational  aspects  in 
Section  2.4.  Then  the  relationship  between  the  formula  and  the  aforementioned 
methods  is  covered  in  Section  2.5,  and  finally  some  concluding  remarks  are  made 
in  Section  2.6. 


2.2  Derivation  of  the  Proposed  Equation 

In  this  section,  we  will  derive  extra  equations  which,  together  with  the  kinematic 
equations  of  the  manipulator,  can  fully  specify  the  under-determined  problem. 

The  kinematic  equation  for  the  redundant  manipulator  is  given  as  the  following 
vector  equation: 

x  =  f(#)  (2.1) 

where  x  is  an  m-dimensional  vector  representing  the  location  of  the  end  effector 
with  respect  to  the  base  coordinate  system  in  the  workspace,  9  is  n-dimensional 
vector  representing  joint  variables,  and  f  is  a  vector  function  consisting  of  m 


1  ff  there  were  mo  constraints  on  joint  variable*,  (lie  algorithm  would  he  simpler. 
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scalar  functions,  with  m  <  n.  (2.1)  may  be  rewritten  as 

■F(#)  =  f(#)-x  ,  , 

V  ’  (2.2) 

Let  H (0)  be  the  aforementioned  criteria  function(or  performance  measure)  with 
continuous  first-order  partial  derivatives  with  respect  to  joint  variables,  which 
quantitatively  represents  the  desired  performance. 

Let  us  define  the  Lagranfeian  function  L(0)  as  the  following: 

L(9)  =  ATF(0)  +  H(9)  (2.3) 

where  A  is  an  m-dimensional  Lagrangian  multiplier  vector.  At  the  stationary 
points  of  L, 

3L  __  \T  3F  ,  3H 
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=  0 

where  the  m  x  n  matrix,  ||,  is  the  Jacobian  matrix  J  (Whitney, 1972).  In  (2.4), 
as  x  is  expressed  in  the  base  coordinate  system,  so  are  the  Lagrangian  function 
and  the  Jacobian  matrix.  The  second  term  in  the  right  hand  side(r.h.s.)  of  (2.4) 
is  the  transpose  of  the  gradient  vector  h  such  as 

h  =  (25\ 
hx  =  (i  =  1,2, ..,  n) 


Thus,  (2.4)  becomes  the  following: 


ArJ  =  -h’ 


Transposing,  we  get 
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where  ( J‘)r  denotes  the  transpose  of  i-th  column  vector  of  the  Jacobian  matrix. 
In  (2.6),  we  have  n  linear  equations  with  m  unknowns,  Ai,A2,..,Am.  Selecting  m 
linearly  independent  equations  from  (2.6),  which  may  be  chosen  to  be,  without 
loss  of  the  generality,  the  first  m  equations,  we  have, 
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Inverting,  we  obtain  A,  as 
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Substituting  this  into  the  remaining  n  —  m  equations  in  (2.6),  we  have 
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For  brevity,  let  us  denote 
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Adding  hn_m,  and  multiplying  both  sides  of  (2.8)  by  —1,  we  have 


■In  m  hm  hn  m  —  0 


which  may  be  alternatively  expressed  as 
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where  In-m  is  an  identity  matrix  of  rank  (n  -  m).  If  we  denote 

Z  —  [jn-mdm  :  —  In-m] 

Then  (2.8)  becomes 


Zh  =  0 


(2.9) 


(2.10) 


where  Z  and  h  are  defined  as  above.  If  we  combine  the  kinematic  equation,  (2.1), 
with  (2.10),  as  a  system  of  equations,  we  get 


x  =  f  (#) 

Zh  -0 


(2.11) 


Since  Z  is  an  (n  -  m)  x  n  matrix,  and  h  is  an  n-dimensional  vector,  (2.10) 
consists  of  (n  -  m)  scalar  equations  with  n  unknowns,  0.  On  the  other  hand, 
the  kinematic  equation,  (2.1),  has  m  scalar  equations.  Therefore,  (2.11)  has  n 
independent  nonlinear  equations  which  now  fully  specify  the  n  unknowns. 

Note  that  finally  we  have  derived  the  expected  formula,  Equation  2.11  —  a 
simple  yet  general  formula  that  provides  with  a  direct  mapping  from  workspace 


to  joint  space.  In  (2.11),  the  additional  set  of  constraints,  (2.10),  resolve  the 
redundancy  —  at  the  inverse  kinematic  level  —  in  such  a  way  that,  under  the 
kinematic  constraint  of  (2.1),  the  criteria  function,  H(9),  may  be  minimized. 
Note  also  that  (2.11)  has  to  be  solved  numerically. 

2.3  Characteristics 

In  this  section,  we  will  examine  the  additional  set  of  constraints,  with  the  kine¬ 
matic  equation,  more  in  depth.  The  fact  that  the  matrix  Z  consists  of  the  elements 
of  J  alone  implies  that  it  may  have  a  close  relationship  with  the  Jacobian  matrix. 
Then,  what  is  the  relationship?  The  following  theorems  gives  the  answer. 

Theorem  1  The  rank  of  Z  defined  in  (2.10)  is  n  -  m 

Proof: 

The  rank  of  any  matrix  is  the  dimension  of  its  largest  nonsingular  submatrix. 
Since  In-m  is  the  largest  nonsingular  matrix  for  Z,  the  rank  of  Z  (and  Zr,  too) 
is  n  -  m. 

T  >rem  2  JZT  —  0 


Proof: 


T  fi  T  .  t 

—  iJ  m  •  ^n-m 


T i  I  Mm  ,)T(^n-m  *)T 


(2.12) 


Here,  Theorem  2  shows  that  all  the  column  vectors  of  Zr  are  orthogonal  to  J, 
whereas  Theorem  1  tells  us  that  the  number  of  the  column  vectors  are  equal  to  the 
rank.  Thus,  column  vectors  of  Zr(or  row  vectors  of  Z)  are  a  set  of  basis  vectors 
which  span  the  null  space  of  J.  From  this  fact,  we  may  conjecture  that  Equation 


a 

i 


(2.10)  could  be  the  direct  counterpart  of  the  homogeneous  solution  term  of  the 
Resolved  Motion  Method,  which  also  uses  the  null  space  to  resolve  the  redundancy. 
This  conjecture  will  be  proved  in  Chapter  3,  where  the  relationship  between  the 
proposed  formula  and  the  Resolved  Motion  Method  will  be  focused  on  more  in 
detail. 

In  (2.10),  note  that  the  matrix  Z  depends  on  the  intrinsic  kinematic  property 
of  a  manipulator,  while  h  depends  on  an  arbitrarily  imposed  property.  There¬ 
fore,  if  a  symbolic  form  of  Z  is  available  —  which  is  not  very  difficult,  once  the 
Jacobian  matrix  can  be  expressed  in  a  symbolic  form  —  we  have  only  to  replace 
h,  depending  on  the  desired  performance,  without  having  to  derive  the  equation 
all  over  again.  For  example,  consider  a  seven  degrees  of  freedom  robot  having  the 
following  Jacobian  matrix  as  shown  in  (Luh,1985): 


-a2c23 

I2S3  +  <*3 
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0 
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a3s23  +  l'ic2 
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S4S5 
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C5 

where  /2,  /3,  and  a2.  a3  represent  the  link  parameters,  while  the  variables  with 
subscripts  are  defined  as 

Si  --  sm(0,),  Sij  k  -  sm(0,  +  Bj  +  ...  +  9k), 

C,  —  COS^Bi ) ,  Cf k  —  COS (Bi  ~t ~  0j  ...  0k)i  *1  Ji  "i  ^  =  1 1  2,  3 

Substituting  the  Jacobian  matrix  into  (2.10),  and  symbolically  manipulating 
with  MACSYMA(Macsyma  Manual),  we  have  Z  in  the  following  form: 

Z  =  |0  O3S5  (/2s3  -r  03)65  a3/2c3S5  /2s3.s4C5  I2S3C4S5  -  /2s3s4}  (a3s23  +  /2c2) 


(2.13) 


Note  that  we  have  derived  an  expression  of  Z,  apart  from  h. 


In  (2.10),  any  criteria  function  may  be  used,  as  long  as  the  function  can  be 
reduced  to  an  expression  in  terms  of  joint  variables  only.  For  instance,  consider  the 
following  criteria  function,  H(i),  for  the  obstacle  avoidance  problem(Nakamura,1985)2: 

//  -  ko  t  l/{Co(x()  -  1}  +  kj  £  l/(Cax  -  *;),  (2.14) 

.=1  ]=l 

where  k0  and  kj  are  scaling  factors;  x<  =  (xij,xj,,  xa)T  is  the  position  of  the  *-th 
point  among  l  points  on  the  manipulator;  0jma x  is  the  limit  of  j-th  joint;  and  the 
model  of  the  obstacle  in  the  workspace,  Co(x*),  is  defined  as, 

Co(x.)  =  (2  IS) 

k=l  r* 

where  x^,  rk,  and  s  are  the  center  coordinate,  radii,  and  roundness  exponent 
of  the  obstacle  object.  Note  that  we  can  reduce  H  to  a  function  of  $  only,  by 
transforming  x,  into  f,(0)  using  (2.1),  and  thus  can  apply  (2.10)  to  it. 


2.4  Computational  Consideration 

In  this  section,  an  analysis  will  be  made  with  regard  to  the  computational  effort 
required  to  solve  (2.11).  Much  of  the  analysis  is  based  on  the  various  results  of 
the  research  on  computational  efforts.  So  one  can  find  more  detailed  discussions 
in  the  references  cited  in  this  subsection. 

For  the  sake  of  generality,'  we  consider  the  general  manipulator  without  any 
special  geometry,  thus  assuming  that  J  and  Z  are  not  given  in  the  symbolic  form. 
A  special  geometry  that  allows  the  symbolic  form,  of  course,  would  enable  much 
more  efficient  computations. 

The  computational  effort  will  be  measured  in  terms  of  arithmetic  operations 
such  as  addition,  subtraction,  multiplication,  and  division.  Furthermore,  we  as¬ 
sume  that  the  four  arithmetic  operations  require  approximately  the  same  amount 
"(lie  problem  war  originally  treated  in  the  dynamic  context  by  using  a  potential  function. 
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of  computation  time,  and  the  effort  required  to  evaluate  trigonometric  functions 
is  negligible  as  compared  to  the  total  computational  effort. 

2.4.1  Motion  strategy 

In  order  to  compute  the  joint  trajectory  for  a  given  Cartesian  path,  We  need, 
briefly  speaking,  to  take  the  following  procedures:  we  first  determine  via  points 
on  the  path;  then  obtain,  by  using  inverse  kinematic  methods,  corresponding 
points  in  the  joint  space;  and  finally  concatenate  these  angles  to  generated  the 
joint  trajectory. 

How  to  generate  the  via  points,  and  how  to  determine  an  appropriate  number 
of  the  points  are  important  subjects  in  the  motion  planning  area.  Too  many  via 
points  result  in  a  wasteful  computation  and  slow  motion,  whereas  too  few  result 
in  inaccurate  trajectory  control.  In  addition  to  deciding  the  via  points,  how  to 
generate  intermediate  points  between  the  via  points  is  another  important  issue. 
Usually  interpolation  methods  are  used  to  generate  intermediate  points,  which 
we  will  call  knot  points. 

When  obtaining  joint  values  corresponding  to  a  via  point,  we  use  iterative 
methods  if  a  symbolic  solution  is  not  available.  So,  determining  joint  angles  for  a 
via  point  involves  a  number  of  iteration  steps;  each  step  in  turn  requires  a  series  of 
computations.  Hence,  the  total  computational  effort,  Ntotai ,  required  for  a  given 
trajectory  is  obtained  in  general  as  the  following: 


^  total 

-  N  +  YN"'" 

—  iy  con  t  jfc=  1 

Nk 

—  ^ iteration^ step 

where  Ncon  is  the  computational  effort  for  concatenating  knot  points  either  in 
workspace  or  joint  space,  Nvia  the  number  of  via  points,  the  computational 
effort  for  inverse  kinematics  at  each  point,  Nlter,u „m  the  number  of  iterations  at 


the  point,  and  N,tep  the  computational  effort  at  each  iteration  step.  Assuming 
that,  as  compared  to  the  other  term  in  Ncnn  is  relatively  small,  we  will  only 

discuss  each  of  remaining  terms,  in  a  reverse  order. 

2.4.2  Computational  Effort  at  Each  Iteration  Step 

If  (2.11)  is  to  be  solved  numerically,  the  computational  effort  at  each  iteration 
step,  JV,1<;p  (or  AT,  in  this  case),  is  evaluated  as  follows: 

./Vj  =  Nfk  +  Nj  +  Nzh  +  Nn  i  (2.16) 

where  Nfk  denotes  the  computational  effort  required  for  the  forward  kinematics, 
(2.1),  Nj  the  effort  to  obtain  the  Jacobian  matrix,  Nzh  for  Zh  in  (2.10),  and  Nni, 
the  effort  needed  by  the  numerical  method  for  solving  the  system  of  nonlinear 
equations. 

For  the  general  manipulator  with  revolute  joints  —  no  significant  difference 
is  expected  when  a  few  prismatic  joints  are  included  —  Nfk  is  given  as  (Ange¬ 
les,  1985) 

Nfk  =  Nb  +  Nj 

Nr  =  36(n  -  1)  f  4;  NT  =  16(n  -  1)  +  2 
where  NR  and  Nt  indicate  the  computational  efforts  required  to  compute  orien¬ 
tation  and  position  of  the  end  effector3. 

Nj  for  the  general  manipulator,  with  Waldron’s  scheme,  is  given  as  (Orin,1984) 

Nj  =  45n  -  93  (2.18) 

Since  we  have  not,  at  this  point,  chosen  a  specific  criteria  function  from  a  variety 
of  choices,  let  us  simply  assume  that  we  have  derived  h  with  relatively  a  small 

3  We  derived  these  general  formula  on  the  basis  of  the  computation  algorithm  in  (Angeles,  1085). 
Slightly  different  formula  can  result  depending  on  different  computation  details 


(2.17) 


amount  of  computation  as  compared  to  the  other  parts  of  computation.  If  we 
assume  at  the  same  time  that  a  symbolic  form  of  Z  is  not  available,  Zh  in  (2.10)  is 
more  efficiently  computed  by  first  solving  for  A  in  (2.7)  with  Gaussian  elimination, 
and  then  substituting  it  as  in  (2.8).  Thus,  NZh  is  given  as  follows: 

**  ,  <2.19, 

Ng  =*f-  +  ^  -7f\  N,  =  (n  -  m)(2m  -  1) 

where  Ng  is  the  effort  for  Gaussian  elimination(Nakamura,1985),  and  N,  is  that 
for  the  substitution. 

If  we  use,  for  example,  MINPACK-1,  one  of  the  well-known  software  packages, 
to  solve  the  system  of  nonlinear  equations,  the  computational  effort,  Nnj,  becomes 
(MINPACK  Manual) 

Nnl  =  11. 5n2 

This  package,  by  the  way,  is  primarily  based  on  an  improved  version  of  Powell’s 
hybrid  method,  a  method  that  combines  the  Newton-Raphson  method  with  the 
steepest  descent  method  (MINPACK  Manual). 

Consequently,  the  total  effort  of  computation  for  the  general  manipulator  with 
kinematic  redundancy  per  iteration  for  the  proposed  method  becomes  as  follows: 

N\  —  -m3  +  11. 5n2  +  2nm - - - 1-  96n  —  139  (2.20) 

3  2  6 

As  an  example  to  show  the  total  computational  effort  as  well  as  the  relative 
significance  of  each  part  in  it  in  a  realistic  situation,  let  us  evaluate  the  effort  when 
n  =  7  and  m  =  6.  According  to  aforementioned  estimations,  we  have  N\  =  1306, 
in  which,  NFK  =  318,  Nj  =  222,  Nzh  =  202,  Nn  l  =  564. 

2.4.3  Number  of  Iterations 


The  number  of  iterations  required  for  a  system  of  nonlinear  equations  depends  on 
several  factors.  Among  these,  there  are  some  major  ones  such  as  the  initial  esti- 


mate  of  solution,  the  particular  updating  algorithm  being  used,  and  the  distance 
of  the  estimate  at  the  present  step  from  singularities. 

In  the  inverse  kinematic  context  when  the  end  effector  is  successively  passing 
adjacent  points,  the  initial  estimates  are  usually  good  enough  to  use  such  a  fast 
converging  algorithm  as  the  Newton- Raphson  method.  For  applications  with 
poor  initial  estimates,  however,  we  need  some  correctional  algorithms  such  as 
the  steepest  descent  method.  Alternatively,  we  may  use  a  method  that  combines 
the  Newton- Raphson  method  and  steepest  descent  method,  such  as  the  Powell’s 
hybrid  method  mentioned  in  the  previous  subsection. 

With  the  Powell’s  method,  solving  a  system  of  nonlinear  equations  that  con¬ 
sists  of  trigonometric  functions  —  thus  very  similar  to  the  kinematic  equations 
—  is  reported  to  require  from  about  12  to  15  iterations  for  systems  of  up  to  nine 
equations(Rabinowitz,1970).  This  data  shows  a  good  agreement  with  the  result 
by  Benhabib  et  al(1986),  which  reports  that  the  number  of  iterations  for  seven 
degrees  of  freedom  redundant  manipulators  is  less  than  15. 

2.4.4  Minimum  Number  of  Via  Points 

One  extreme  approach  to  control  the  motion  of  the  end  effector  is  to  obtain  joint 
solutions  at  every  sample  interval.  Obviously  it  requires  considerable  amount  of 
real  time  computation.  One  possible  way  to  improve  the  approach  is  to  compute 
the  joint  solutions  at  every  fcth  interval  and  then  to  interpolate  on  joint  angles 
(Taylor, 1979).  The  difficulty  with  this  way  is  that  the  number  k  that  guarantees 
a  certain  deviations,  when  interpolation  is  performed,  from  the  desired  path  is 
changing  from  point  to  point.  So  a  fixed  k  small  enough  to  ensure  a  given  deviation 
everywhere  in  the  workspace  requires  still  considerable  amount  of  computation. 

Another  approach  (Benhabib,  1986)  is  to  precompute  joint  solutions  for  suf¬ 
ficiently  large  amount  of  via  points  in  the  Cartesian  coordinates  off-line,  and  to 


interpolate  joint  angles  on-line.  This  approach  may  also  waste  computations  and 
storages,  since  this  sufficient  amount  is  not  the  same  everywhere.  In  addition, 
this  approach  requires  us  to  know  the  path  and  corresponding  via  points  well  in 
advance,  so  that  we  might  execute  the  motion  without  much  delay. 

Then  there  follows  a  natural  question:  What  is  the  number  of  via  points 
that  is  minimal  yet  guarantee  a  given  deviation?  An  effective  solution  to  this 
question  is  found  in  Taylor’s  algorithm  called  Bounded  Deviation  Joint  Path  ( 
Taylor, 1979).  This  algorithm  computes,  for  a  given  straight  line  segments  in 
Cartesian  coordinates,  nearly  minimal  number  of  via  points  and  corresponding 
joint  solutions,  in  a  recursive  way. 

This  algorithm  requires  one  of  inverse  kinematic  methods.  Furthermore,  it  ap¬ 
pears  to  require,  if  not  explicit,  a  fixed  transformation  from  the  Cartesian  space 
to  joint  space.  As  we  will  show  in  the  following  chapters,  the  proposed  formula 
with  the  kinematic  equation  has  the  property  of  the  fixed  transformation.  There¬ 
fore  this  useful  algorithm  is  expected  to  help  the  proposed  formula  efficiently  and 
accurately  control  kinematically  redundant  manipulators.  We  list  the  algorithm 
in  Appendix  1.  In  Chapter  4,  we  test  the  algorithm  in  conjunction  with  the 
proposed  formula. 

On  the  other  hand,  there  has  not  been,  to  our  knowledge,  any  application 
of  the  algorithm  to  the  kinematically  redundant  case.  In  this  sense,  the  appli¬ 
cation  of  the  algorithm  may  be  considered  an  extension  of  the  algorithm  to  the 
kinematically  redundant  case. 

2.5  Comparison  with  Other  Methods 

In  this  section,  the  proposed  formula  corresponding  to  equation  (2.10)  will  be 
compared  with  two  existing  null  space  expressions:  the  expression  used  by  Luh 


and  Gu  and  the  extended  Jacobian  method.  The  relationships  will  be  investigated 
on  the  basis  of  these  comparisons. 

2.5.1  Relationship  with  Luh’s  Expression 

Luh  and  Gu  (Luh,1985)  proposed  a  null  space  matrix  which  is  defined  as 

Nr  =  (n,  •••nr) 

where  n',s  (i  1 , 2.  •  •  • ,  n  —  m)  are  orthogonal  to  every  row  vector  of  the  Jacobian 
matrix,  so  that  for  each  n,,  Jn,  =  0. 

Comparing  this  equation  with  (2.12),  we  see  immediately  that  Nr  is  a  generic 
form  of  Zr;  or  conversely,  ZT  is  a  specific  expression  of  Nr.  Since  how  to  find  Nr 
was  not  given,  the  formulation  of  Z  in  (2.9)  provides  with  a  systematic  mean  to 
determine  Nr. 

2.5.2  Relationship  with  Extended  Jacobian  Method 

Baillieul,  in  the  process  of  deriving  a  rate  equation  called  the  extended  Jacobian 
Method,  presented  another  method  to  resolve  the  redundancy,  also  at  the  inverse 
kinematic  level  (Bailleui,  1985, 1986).  This  method  derives  the  additional  con¬ 
straints  by  using  the  orthogonality  characteristics  between  the  gradient  vector  of 
the  criteria  function  and  the  null  space  matrix  of  J  at  the  optimum,  as 

(I  -  J+J)h  =  0  (2.21) 

where  J  +  is  the  pseudoinverse  of  J  as  mentioned  before. 

From  the  resulting  fully  specified  system  of  equations,  one  derives  the  new 
Jacobian  matrix,  called  the  extended  Jacobian,  by  partially  differentiating  with 
respect  to  the  joint  variables,  just  in  the  same  way  as  in  the  nonredundant  case. 
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Among  the  n  scalar  equations  in  (2.21),  only  n  -  m  equations  are  independent 
constraints  to  be  determined;  for  the  rank  of  the  null  space  matrix  is  n  -  m.  The 
detailed  procedures  of  determining  the  n  —  m  constraints  and  their  concrete  func¬ 


tional  forms  are  not  known  yet,  except  for  the  case  n  —  m  +  1.  When  n  =  m  +  l, 


that  is,  for  the  manipulator  with  just  one  redundant  degree  of  freedom,  a  con¬ 


straint  is  derived,  through  a  series  of  procedures,  as  the  following  (Baillieul,1985) 


G($)  -  njh 


(2.22) 


where 


nj  -  (A,,  A2,..,  An)T  (2  23) 

A,  =  {-l)'+ldet(J\ 

where  det(.)  is  the  determinant,  with  Jk  the  A:-th  column  vector  of  the  Jacobian 


matrix. 


It  is  shown  in  Appendix  2  that  (2.10)  reduces  to  (2.22)  in  the  case  that  n  — 
m  +  1.  Considering  this  fact  and  that  Z  in  (2.10)  is  a  null  space  matrix  of  rank 
n  -  m,  we  may  regard  (2.10)  as  a  concrete  expression  of  n  -  m  independent 


constraints. 


2.6  Conclusion 


To  sum  up,  we  have  obtained  a  closed-form  formula  for  the  inverse  kinematics 


of  redundant  manipulators.  It  was  demonstrated  that  the  proposed  formula  is 


concise  in  form,  general  in  application,  and  easy  to  include  the  desired  perfor¬ 
mance.  It  was  shown  that  the  matrix,  Z,  in  the  formula  consists  of  a  set  of  the 


basis  vectors  of  the  null  space  of  the  Jacobian  matrix.  The  comparison  of  the  for¬ 


mula  to  the  other  methods  shows  that  the  formulation  provides  with  a  systematic 


mean  to  obtain  Luh’s  null  space  matrix  and  that  the  formula  serves  as  a  concrete 


expression  for  the  general  case  of  Baillieul’s  formulation.  Whether  the  formula  is 
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Chapter  3 


Relationship  with  Resolved 
Motion  Method 


3.1  Introduction 

In  Chapter  2,  we  proposed  a  formula  that  resolves  the  kinematic  redundancy 
at  the  inverse  kinematic  level,  by  using  the  null  space.  The  similarity  of  the 
formula  to  the  null  space  term  of  the  Resolved  Motion  Method  led  to  a  conjecture 
that  the  former  may  be  the  counterpart  of  the  latter  at  the  inverse  kinematic 
level.  In  this  Chapter,  we  will  investigate  their  relationship  and  try  to  prove 
that  the  conjecture  is  correct.  Not  only  for  that,  we  will  also  derive  from  the 
proposed  formula  the  counterpart  at  the  differential  level.  In  addition,  we  will 
compare  the  numerical  efficiencies  of  the  two  methods,  too.  In  conjunction  to 
the  comparison,  we  will  discuss  the  repeatability  problem  in  the  Resolved  Motion 
Method,  which  was  pointed  out  in  (Baillieu!,1985;  Klein, 1983),  and  examine  if 


3.2  Resolved  Motion  Method 


In  this  section,  we  first  introduce  the  Resolved  Motion  Method  for  the  redundant 
case  and  review  its  characteristics.  Then  the  causes  of  repeatability  problem  in 
this  method  will  be  analyzed. 

3.2.1  The  Method  and  Its  characteristics 

The  kinematic  equation  for  manipulators  given  in  (2.1)  is  again, 

X  -  f(#)  (3.1) 

where  x  is  an  m-dimensional  vector  representing  the  location  of  the  end  effector 
with  respect  to  the  base  coordinate  system  in  the  workspace,  0  is  n-dimensional 
vector  representing  joint  variables,  and  f  is  a  vector  function  consisting  of  m 
scalar  functions. 

As  mentioned  in  Section  1.1.1,  the  Resolved  Motion  Method  first  derives  the 
differential  relationship  by  differentiating  the  kinematic  equation  with  respect  to 
time  as 

x  =  J0  (3.2) 

w’here  the  Jacobian  matrix  J  defined  as  J  =  |  is  an  m  x  n  matrix  (Whit¬ 
ney, 1972).  Then  by  inverting  the  matrix,  we  obtain  the  joint  velocity,  8.  For  the 
nonredundant  case(n  =  m),  J  being  square,  we  can  have  0  as 

0  =  J  'x. 

For  the  redundant  case,  however,  since  n  >  m,  J-1  does  not  exist.  Instead, 
we  use  a  generalized  inverse,  J  +  ,  as  (Ben-Israel  and  Creville,  1980), 


where  J+  is  defined  as 


j+  =  (3.4) 

This  matrix,  known  as  Moore-Penrose  pseudoinverse,  has  by  the  way  the  following 
properties: 


JJ+J 

=  J 

J+JJ+ 

=  J+ 

(J+J)r 

=  J+J 

(JJ+)T 

+ 

•-9 

II 

The  most  general  solution  to  (3.2)  is  known  to  be  (Ben- Israel,  1980) 

$  =  J+x  +  £*(I-  J  J)h  (3.5) 

where  (I  -  J+J)  is  the  null  space  of  J,  with  a  a  gain  constant,  and  h  an  arbitrary 
vector.  Equation  (3.5)  gives  a  way  to  resolve  the  redundancy  at  the  velocity  level. 
We  may  call  the  first  term  in  the  r.h.s.  a  special  solution,  and  the  second  term  a 
homogeneous  solution. 

Liegeois(Liegeois,1977)  developed  a  formulation  of  resolution  of  redundancy, 
such  that  a  scalar  criteria  function  may  be  minimized,  by  setting  to  the  vector  h 
the  gradient  vector  of  the  criteria  function,  H  as  in  (2.5).  He  expresses  (3.5)  in 
terms  of  the  infinitesimal  displacement,  as 

dO  =  J+dx  +  a(I  -  J+J)h 
a  =  adt 

In  (3.6)(or  (3.5)),  at  time  t,  the  special  solution  first  moves  the  end  effector  to  a 
location  x(<).  Then,  the  homogeneous  solution,  on  the  other  hand,  forces  joints 
to  have  self-motion  to  achieve  an  equilibrium  (or  optimum),  O' ,  where  H  has  a 
local  minimum,  for  x(t).  In  practice,  however,  it  takes  a  certain  amount  of  time, 
St,  for  the  joint  variables  to  reach  $  ,  when  the  end  effector  has  already  moved 
to  a  new  location,  x(t  +  <5t)  —  thus  requiring  a  new  0  .  Therefore,  the  joint 
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(3.6) 


variables  never  reach  the  optimal  configuration,  but  continuously  trail  behind 
with  a  slight  difference  in  the  direction  of  the  end  effector  displacement,  dx.  In 
other  words,  if  the  end  effector  would  stay  at  a  location  sufficiently  long,  the 
joints  could  eventually  achieve  the  opiimal  configuration  corresponding  to  that 
location.  This  analysis  appears  helpful  for  understanding  the  following  problem. 

3.2.2  Repeatability  Problem 

The  repeatability  in  the  robotics  context  may  be  defined  as  the  ability  to  give 
the  same  joint  values  for  a  given  location  in  workspace,  regardless  of  the  path  of 
end  effector  to  that  location.  In  mathematical  terms,  the  repeatability  means  the 
fixed  transformation  from  the  workspace  to  joint  space.  The  lack  of  repeatability, 
of  course,  can  be  a  considerable  drawback  in  robot  manipulators  which  perform 
cyclic  tasks,  because,  as  the  end  effector  traces  the  cyclic  path,  joint  variables 
evolve  into  states  which  cannot  be  predicted  in  advance. 

Klein  and  Huang  (Klein  and  Huang, 1983)  noted  this  problem  in  (3.3),  the 
Resolved  Motion  Method  without  null  space  term.  Baillieul  mentioned  the  same 
problem  in  (3.6),  the  method  with  null  space  term  (Baillieul, 1985).  Then  what 
would  be  exactly  the  reason  for  this  problem?  The  above  analysis  on  the  charac¬ 
teristics  of  the  method  may  help  understand  the  reason. 

More  specifically,  the  analysis  implies  that  the  problem  is  caused  by  the  fol¬ 
lowing  two  factors: 

1.  Because  of  the  directionality  of  dx  in  the  special  solution,  the  joint  variables 
have  different  values  depending  on  the  direction  of  the  repeated  path  — 
for  instance,  a  cyclic  path  —  in  the  workspace.  Note,  however,  that  the 
repeatability  can  be  preserved  when  tracing  only  one  direction  of  the  cyclic 
path  even  in  the  presence  of  this  factor  (Baillieul, 1985). 


2.  Because  of  the  irreversibility  of  the  homogeneous  solution  part,  they  never 
return  to  the  initial  configuration,  once  the  joint  variables  reach  a  steady 
state  trajectory  near  to  the  optimal  trajectory,  0(t)  .  This  situation  can 
happen  at  the  initial  transient  period  when  initially  guessed  joint  values 
are  far  from  the  optimum;  for  the  optimal  joint  values  cannot  be  known  in 
advance. 

Beside  these  factors,  as  briefly  mentioned  in  Section  1.1.3.,  another  pattern 
of  repeatability  problem  can  exist  when,  among  the  multiple  joint  configurations, 
transition  from  one  configuration  to  another  happens.  About  this  pattern  of 
repeatability,  we  will  discuss  more  in  detail  later. 

To  sum  up,  our  analysis  on  the  characteristics  and  the  repeatability  problem  of 
the  method  may  lead  to  a  conclusion:  if  we  stay  in  one  kind  of  joint  configuration, 
and  if  we  trace  the  equilibrium(or  optimal)  joint  values  0'(t),  then  we  can  pre¬ 
serve  the  repeatability.  Then  this  conclusion,  together  with  the  aforementioned 
conjecture  between  the  two  methods,  brings  about  another  question:  What  is 
the  relationship  between  the  equilibrium  states,  0  (t),  and  the  states  that  satisfy 
Equation  (2.11)?  The  following  section  gives  the  answer  to  this  question. 

3.3  Relationship  between  the  Two  Methods 

In  this  section,  we  will  investigate  the  relationship  between  the  proposed  formula 
and  the  Resolved  Motion  Method.  More  specifically,  we  will  try  to  give  the 
answer  to  the  question  raised  in  the  previous  section:  the  relationship  between  the 
equilibrium  states  of  the  Resolved  Motion  Method  and  the  solutions  of  Equation 
(2.1 1).  At  the  same  time,  we  will  derive  a  rate  equation,  or  differential  relationship 
like  the  Resolved  Motion  Method,  from  Equation  (2.11). 


3.3.1  Equilibrium  State 

In  the  Resolved  Motion  Method  expressed  in  (3.6),  if  the  end  effector  stays  at  a 
location  sufficiently  long,  the  joints  arrive  at  the  equilibrium,  stopping  the  self- 
motion.  Hence  we  have  d$  =  0,  in  addition  to  dx  —  0  —  the  condition  for  fixed 
end  effector  location.  Therefore,  from  (3.6)  we  have 

(I  -  J+J)h  =  0. 

It  is  proved  in  Appendix  3  that  this  equation  holds  if  and  only  if  (2.10)  holds;  thus 
the  proposed  formula  is  the  necessary  and  sufficient  condition  to  be  satisfied  when 
(3.6)  has  converged  to  its  equilibrium  states.  In  other  words,  (2.11)  gives  the  exact 
equilibrium  state,  the  optimal  joint  configuration,  at  which  (3.6)  will  eventually 
arrive  by  self-motion  for  a  fixed  end  effector  location.  Thus,  we  may  regard  (3.6) 
in  the  Resolved  Motion  Method  as  an  approximated  equation  linearized  at  states 
that  are  exactly  determined  by  (2.11).  Note  that  the  above  equation  is  the  same 
as  the  extra  set  of  constraints  proposed  by  Baillieul  (Baillieul,1986). 

The  practical  implication  of  this  relationship  would  be  that  we  can  obtain  the 
equilibrium  joint  values  either  by  solving  (2.11)  or  by  making  sufficient  iteration 
of  null  space  term  of  Resolved  Motion  Method  with  fixed  end  effector  location. 
However,  as  mentioned  in  Section  1.1.1,  Resolved  Motion  Method,  being  a  rate 
equation,  is  not  self-starting:  given  a  location  of  end  effector,  corresponding  equi¬ 
librium  joint  values  cannot  be  determined  without  using  other  methods. 

When  approaching  the  equilibrium,  the  speed  of  convergence  is  determined  by 
the  value  of  a:  the  larger  the  value,  the  faster  is  the  convergence.  The  value  of 
a,  however,  has  an  upper-limit,  above  which  the  equation  becomes  numerically 
unstable,  not  to  mention  that  the  manipulator  cannot  respond  because  of  the 
torque  limitation. 
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3.3.2  Differential  Relationship 

The  proposed  formula  and  the  kinematic  equation,  in  contrast  to  the  Resolved 
Motion  Method,  are  a  set  of  state  equations  or  equilibrium  equations  that  maps 
from  one  space  to  another.  Yet,  these  equations  have  in  themselves  all  the  neces¬ 
sary  informations  about  motion  such  as  velocity  and  acceleration.  Then  how  do 
we  derive  motion  from  these  state  equations?  More  specifically,  how  do  we  derive 
the  joint  velocity  from  these  equations? 

This  question,  obviously,  is  practically  important,  because  often  we  need  to 
know  joint  velocity  beside  joint  displacement.  For  example,  when  the  dynamic 
control  is  needed,  or  when  the  motion  is  specified  in  terms  of  end  effector  velocity, 
it  is  more  convenient  to  obtain  joint  velocity,  by  using  the  differential  relationship, 
than  to  obtain  joint  displacement. 

To  derive  the  joint  velocity  from  (2.11),  we  have  at  least  two  ways: 

1.  Differentiate  the  equation  with  respect  to  time.  Then,  the  Kinematic  equa¬ 
tion  part  becomes  the  well  known  Jacobian  equation,  x  =  JO,  while  the 
second  part  becomes  0  =  J T0,  where  Jr  =  Combining  these,  the 

resulting  equation  becomes 


where 


Inverting  the  above  equation  gives  the  joint  velocity.  Here,  Je  is  so  called 
the  extended  Jacobian  matrix  by  Baillieul  (Baillieul,  1985, 1986) 


2.  Since  J  is  given,  use  the  pseudoinverse  method  in  (3.6). 


The  first  way,  although  conceptually  simple,  turns  out  to  be  an  inefficient 
method,  because  Jr  is  a  very  complicated  matrix  —  see  the  expression  in  (Bail- 
lieul,1985).  In  the  second  way,  on  the  other  hand,  we  need  to  evaluate  J+  from 
J,  which  requires  a  substantial  computation  effort  —  note  that  we  cannot  make 
use  of  Z  already  obtained  with  another  intensive  computation. 

Instead,  we  can  derive  joint  velocity  by  using  the  following  relationship,  the 
proof  of  which  is  in  Appendix  5: 


=  JEl 


0 


where  Im  is  the  identity  matrix  of  rank  m  and  J£  is  defined  as 


"  E  ~ 


J 

Z 


Then  the  null  space  matrix  is  determined  as 


I  -  J+J  =  .l*1 


0 

z 


Substituting  these  matrices  into  (3.6),  we  have 


9  =  j;' 


x 

Zh 


(3.7) 


(3.8) 


(3.9) 


(3.10) 


By  this  way,  we  can  make  use  of  the  already  obtained  Z,  and  thus  saving  compu¬ 
tation  time. 


3.3.3  Summary 

The  relationship  between  (2.11)  and  (3.6)  may  be  clearly  summarized  in  the  fol¬ 
lowing  block  diagram.  The  comparison  of  numerical  efficiency  for  one  iteration  is 
treated  in  the  next  section,  whereas  the  overall  computation  efforts  are  compared 
in  Chapter  4  and  Chapter  7. 


I 

Inverse  Kinematics,  Resolved  Rate 


Figure  3.1:  The  Relationship  Between  The  Proposed  Method  And  The  Re¬ 
solved  Motion  Method;  The  Direct  Mapping  And  The  Differential  Mapping 

3.4  Computational  Consideration 

In  light  of  the  relationships  between  the  two  methods,  each  of  them  can  be  used 
as  an  alternative  of  the  other  to  solve  both  the  equilibrium  states  and  differential 
variables.  More  specifically,  we  can  obtain  the  equilibrium  state  with  the  Resolved 
Motion  Method,  instead  of  the  proposed  method,  by  iteratively  applying  the 
homogeneous  part  of  (3.6).  Joint  velocities,  on  the  other  hand,  can  be  obtained 
with  (3.10)  instead  of  the  Resolved  Motion  Method,  too.  Then  in  obtaining 
these,  how  do  the  two  methods  compare  computationally?  To  answer  this,  the 
two  methods  will  be  compared  in  the  following  subsections. 

3.4.1  Obtaining  equilibrium  States 

In  comparing  the  two  methods,  the  following  two  questions  should  be  answered: 
1.  how  many  arithmetic  operations  per  iteration  does  each  method  require? 
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2.  how  many  iterations  are  necessary  for  each  method  to  achieve  the  same 
degree  of  accuracy(and  repeatability)  from  the  same  initial  condition? 

The  former  question  will  be  briefly  examined  here  by  first  evaluating  the  num¬ 
ber  of  operations  per  iteration  for  the  Resolved  Motion  Method,  and  then  com¬ 
paring  it  with  that  for  the  proposed  method  already  obtained  before.  The  latter, 
on  the  other  hand,  was  partly  answered  in  Section  2.4.4  for  the  proposed  method. 
Yet  since  the  number  of  iterations  for  Resolved  Motion  Method  is  not  known,  the 
complete  answer  can  be  made  through  a  computation  example  for  a  special  case 
in  the  following  chapter. 

As  in  Chapter  2,  it  is  assumed  that  the  numerical  value  h  is  provided  at  each 
iteration  step  with  relatively  small  amount  of  computation. 

The  computational  effort,  N\,  required  for  the  proposed  method  at  each  iter¬ 
ation  step  was  obtained  in  (2.20)  as 

„r  2  ,  ,  m2  m 

iV,  =  -m  i-  11. 5n2  +  2nm - - - —  +  96n  -  133 

3  2  6 

On  the  other  hand,  the  total  computational  effort  required  for  the  Resolved  Mo¬ 
tion  Method,  iV2,  at  each  iteration  step  or  integration  step,  may  be  expressed 
as 

N,  =  Ntv{Nj  +  Na)  +  N>  (3.11) 

where  Nj  is  the  effort  required  to  compute  the  Jacobian  matrix;  Na,  the  effort 
required  to  evaluate  the  r.h.s  of  (3.6),  once  the  Jacobian  matrix  is  given;  and 
Nev,  the  number  of  times  of  evaluations  of  (3.6);  N*,  the  effort  for  numerical 
integrations.  For  the  general  manipulator,  Nj  is  given  in  (2.18)  as 


Nj  =  45n  -  93 


and  Nj  is  evaluated  in  (Nakamura, 1985a)  as, 

2 


Na  =  -m  +  nm  5 nm  +  mi - m  -  n 

3  3 
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(3.12) 


(3.13)  I 


4 


ft  Itv  1  together  with  Nb,  depends  on  the  specific  numerical  integration  method  to 

be  used.  For  example,  fourth-order  Runge-Kutta  method  requires  that  Nev  =  4 

and  Ar(,  —  13n;  while  most  predictor-corrector  methods  require  that  Nev  —  2  and 

Nb  =  23ra(Hamming,1973).  Considering  that  N?  heavily  depends  on  the  sum  of 

Na  and  Nj,  the  latter  method  is  much  more  efficient. 

Therefore,  Af2  with  the  predictor-corrector  method,  is  given  as 

4  .  .4 

N-i  —  -m3  2 nm2  +  lOnm  +  2 m2  +  11  In - m  -  186  (3-14) 

3  3 

On  the  other  hand,  Runge-Kutta  method  requires 

8  8 

N-i  =  -m3  +  4nm2  +  20nm  +  4m2  +  189n - m  -  372  (3.15) 

3  3 

When  n  =  7  and  m  —  6,  Ni  —  1867  for  the  predictor-corrector  method  and  Ni  = 
3503  for  Runge-Kutta  method,  while  N\  =  1306  again.  In  this  comparison,  we  see 
that,  if  the  predictor-corrector  methods  are  used  for  the  numerical  integration, 
the  Resolved  Motion  Method  requires  about  43%  more  computational  effort  than 
the  proposed  method  per  iteration,  when  n  -  7  and  m  =  6. 


3.4.2  Obtaining  Joint  Velocity 

The  comparison  of  computational  efficiency  of  the  two  differential  relationships 
is  quite  straightforward:  the  only  differences  are  the  integrands  in  the  r.h.s.  of 
(3.6)  and  (3.10).  Therefore  we  have  only  to  compare  the  computational  efforts 
for  these  terms;  the  remaining  terms  are  exactly  the  same. 

For  the  Resolved  Motion  Method,  the  effort  for  the  terms,  Na,  is  again, 


,Vd  =  -m3  +  nm2  +  5nm  +  m2 
3 


2 

-m  -  n 

3 


Meanwhile,  for  (3.10),  the  corresponding  part  denoted,  NJe,  is  obtained  as 


follows: 


where  Nzh  is  the  effort  required  to  compute  Zh,  and  Na„  is  the  effort  for  Gaussian 
elimination  when  inverting  Jg.  NZh  was  evaluated  in  (2.19),  which  is  again 


NZh  =  Ng  +  N, 

Na  =  2-f  +  3-f-  7f;  N,  =  (n  -  m)(2m  -  1) 

where  Ng  is  the  effort  for  Gaussian  elimination(Nakamura,  1985a),  and  N,  is  that 
for  the  substitution  of  Lagrangian  multiplier. 

Meanwhile,  Ncn  is  obtained  simply  by  substituting  m  for  n  in  Ng,  resulting 
in 

„  2n3  3n2  7  n 

N°"  =  X  +  T  “  6 


Hence,  Nje  becomes 


2  n3  3«2  13n  2m3  m2  m 

V  -  4-  - 4-  — - - - — \r  2 nm 

3  3  2  6  3  2  6 


(3.17) 


The  total  computational  effort  N3  for  (3.17)  was  initially  given  as 

N3  =  Nev(Nj  +  N,e)  +  N„ 

Assuming  that  the  predictor-corrector  method  is  used,  and  substituting  for  Nj 
and  Nb  respectively,  7V3  becomes 

4n3  ,  5  4m3  ,  m  . 

N3  ~  — — f-  3n2  —  107 -n  -I - m2 - +  4nm  —  186  (3.18) 

3  3  3  3 

Again  when  n  =  7  and  m  =  6,  N3  =  1597,  as  compared  to  N2  —  1867,  requiring 
about  15%  less  computational  effort. 


3.5  Conclusion 


Summing  up,  we  have  introduced  the  Resolved  Motion  Method  and  observed  that 
the  deviation  from  equilibrium  states  is  due  to  linear  approximation  characteris¬ 
tics.  The  repeatability  problem  was  analyzed  on  the  basis  of  this  understanding. 
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We  concluded  that  the  proposed  formula  provides  with  equilibrium  states  that 
preserve  the  repeatability.  The  equilibrium  states  are  also  the  states  at  which  the 
Resolved  Motion  Method  is  considered  as  a  linearized  equation.  In  addition,  the 
differential  relationship  was  derived  from  the  proposed  formula.  The  computation 
efforts  for  one  iteration  with  the  two  method  were  compared. 


Chapter  4 


Numerical  Experiment  on 
Kinematic  Control  Methods 


i 

I 
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4.1  Introduction 

In  Chapter  2,  we  have  derived  a  closed-form  formula  for  inverse  kinematics  of 
kinematically  redundant  manipulators  that  can  achieve  additional  performances 
represented  in  the  performance  measures.  In  Chapter  3,  we  have  investigated  on 
the  relationship  between  the  formula  and  the  Resolved  Motion  Method,  focusing 
on  the  repeatability  problem.  Although  most  of  the  results  obtained  appear  rather 
obvious,  some  important  points  had  better  be  verified  through  experiments. 

In  this  chapter,  therefore,  we  will  make  numerical  experiments  or  simulations 
to  confirm  some  of  the  important  results.  To  this  end,  we  select  a  kinematically 
redundant  manipulator  and  apply  (2.10).  The  resulting  system  of  equations  is 
solved  numerically  for  x(t),  the  end  effector  location.  In  parallel  to  using  (2.11), 
the  Resolved  Motion  Method  method  is  applied  to  the  same  manipulator  with  the 
same  tip  motion.  The  points  we  try  to  examine  or  verify  through  the  simulation 
are  as  follows: 


1.  Whether  the  resulting  system  in  (2.11)  gives  kinematically  correct  joint 
variables  for  a  given  x,  achieving  the  additional  performance  represented 
by  the  criteria  function  we  select. 

2.  How  the  present  method  compares  to  the  Resolved  Motion  Method  in  terms 
of  accuracy,  repeatability,  and  computational  efficiency. 

3.  Whether  the  present  method  gives,  in  fact,  the  same  equilibrium  states  as 
the  Resolved  Motion  Method  will  eventually  reach. 

In  the  comparison  of  computational  efficiency,  we  consider  two  situations: 
when  solving  the  steady  state  equilibrium  states  with  fixed  tip  location,  and 
when  obtaining  joint  trajectories  with  tip  moving  along  the  Cartesian  path. 

4.2  System  Description 

We  use  the  same  manipulator  presented  in  the  paper  (Yoshikawa,1984)  for  the 
sake  of  comparison  with  data  obtained  in  that  paper:  a  3  degrees  of  freedom 
manipulator  with  the  end  effector  moving  in  the  (x,y)  plane;  thus  kinematically 
redundant.  The  schematic  diagram  with  necessary  parameters  is  in  Figure  4.1. 

The  desired  performance  is  to  avoid  singularity.  A  good  criteria  function  for 
this  objective  may  be  the  manipulability(Yoshikawa, 1984, 1985a),  which  is  given 
as 

H  =  det(JJT)  (4.1) 

The  kinematic  equation  is  given  as 

x  =  I1s1  +  /jSij  +  / S'Sus  ^  2) 

!/  =  h<>i  +  hci2  +  fjCm 
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Figure  4.1:  The  Schematic  Diagram  Of  The  Redundant  Manipulator 


where  llt  /2,  and  l3  represent  the  length  of  each  link,  while  the  variables  with 
subscripts  are  denoted  in  the  same  way  as  in  Equation  2.13,  which  is  again, 


Si  =  sin(0i),  Sij.jt  =  sin(0i  4-  0,  4-  ...  4-  0i), 

c<  =  cos(0j),  Cij..'k  =  cos(0,  +  Oj  4-  ...  4-  Ok),  =  1,2,3 


Then,  the  Jacobian  matrix  is  obtained  as 


vci23  4-  ucu  4*  Cj  vcm  4*  uci2  uci2s 


—  VSns  —  USu  —  Si  — WSijs  —  US  12  — VS123 


where 


•"f  *“ir 


Here,  links  length  are  normalized  in  order  to  simplify  expressions  as  well  as  to 
make  the  analysis  more  general. 

Equation  (4.1),  after  algebraic  manipulations,  reduces  to 


H  —  2sjU*vJ  4-  2S23S3UV*  +  2s*st>8  4-  2s2s2suv  4-  s|uJ 


By  partially  differentiating,  we  obtain  the  gradient  vector,  h  =  (hi,/i2,/is)T,  with 
hi  =  0 

hi  =  2(c2sssu  +  «ajS3)w>  +  2sjjsut;  +  32JuJ 
h3  =  2 (s33u2  4-  Sassu  +  5j2ss)w1  +  2c2s5j«t; 

Meanwhile,  (2.9)  is  simplified  to, 

Z  =  [s3ut>  —  ssuu  —  823V  S23V  +  s2u] 

By  applying  (2.10),  we  get 

2uSi;3(S23S33  -  C2S«s)  +  UUS(2S2S5JS3  -  3S2233«s)  +  2u3t/2S2S33+ 

«JV2(C33  -  C22)  +  2uU2(s2S22S3  —  c252s)  ~  U3VS22S8  —  2u2V323s  (4.4) 

=  0 

where  the  same  definition  as  in  (4.2)  is  used  for  the  subscripts. 

The  system  of  equations,  (4.2),  and  (4.4)  now  fully  specify  the  originally  under- 
determined  system  of  equations,  (4.2),  while  maximizing  the  criteria  H  in  (4.1). 
The  system  of  equations  may  be  solved  either  purely  numerically,  or  by  symbol¬ 
ically  reducing  variables  —  in  this  example,  $i  —  and  then  by  using  numerical 
methods.  Incidentally,  this  example  suggests  that  it  is  possible  to  reduce  vari¬ 
ables,  thus  reducing  the  order  of  the  system  of  nonlinear  equations,  after  resolving 
the  redundancy  first  with  all  the  joint  variables. 

4.3  Procedures 

The  task  is  to  trace  a  square  path  —  thus  a  cyclic  path.  As  shown  in  Figure  4.3, 
the  x-y  coordinates  of  the  four  vertices  of  the  command  path  in  the  workspace 
are  successively  given  counterclockwise  from  the  upper-left  vertex  as  follows: 
(446.00,  91.514), (446.00, -8.486),  (546.00,-8.486), (546.00,  91.514), 
where  the  units  are  mm. 


The  system  of  equations  were  numerically  solved  for  joint  values,  with  regard 
to  consecutive  equidistant  points  on  the  command  path  —  in  this  example,  100 
segments  each  side  —  in  the  counterclockwise  direction.  As  mentioned  before, 
the  MIN  PACK-1  subroutine  was  used  to  solve  the  system  of  nonlinear  equations. 
The  subroutine,  by  the  way,  allows  only  one  set  of  local  solutions,  among  multiple 
sets  of  solutions. 

Meanwhile,  the  Resolved  Motion  Method  in  (3.5)  is  also  applied  to  this  ex¬ 
ample  for  the  same  path,  which  the  end  effector  is  to  track  with  a  constant 
speed  of  10 mm/jee,  (3.5),  a  system  of  differential  equations,  was  solved  with 
the  fourth  order  Runge-Kutta  integration  method,  together  with  the  LINPACK 
subroutines,  with  the  integration  time  step  size,  At  =  0.01  seconds.  We  can  also 
use  the  predictor-corrector  method  for  the  better  efficiency  at  the  cost  of  the  non 
self-starting  disadvantage  and  more  complex  program. 

The  simulation  for  the  Resolved  Motion  Method  was  made  with  initial  joint 
angle  values  of  (-40.5006,  141.6408,  78.4169)  in  degrees,  which  are  far  from  equi¬ 
librium  states,  that  were  deliberately  selected  to  examine  repeatability.  The  same 
initial  value  was  also  used  as  the  initial  guess  for  the  above  nonlinear  equations 
for  fair  comparison  of  the  two  methods. 

In  addition  to  tracking  the  square  path,  another  path  was  traced  in  order  to 
compare  the  efficiency  in  the  case  when  obtaining  the  joint  trajectory  is  required. 
The  path  tried  is  a  straight  line  path  connecting  x  =  0.1m,  y  =  0m  and  i  = 
1.6m,  y  =  0m,  along  which  the  tip  reciprocates.  The  proposed  formula  is  used 
to  obtain  joint  angles  corresponding  to  the  via  points  determined  with  Taylor’s 
algorithm  mentioned  in  Section  2.4.4.  The  via  points  of  the  Resolved  Motion 
Method,  on  the  other  hand,  are  simply  the  equidistant  points  determined  by  line 
segments(the  constant  tip  speed  multiplied  by  the  integration  time  step).  Thus, 
with  this  method,  the  equidistant  via  points  are  determined  either  by  varying  tip 
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speed  or  the  integration  time  step.  For  the  proposed  formula,  hence,  the  deviation 
is  automatically  bounded  within  a  specified  value,  whereas  for  the  other  method 
the  the  deviation  is  controlled  by  varying  the  tip  speed  or  time  step  with  trial 
and  error. 


4.4  Results 

The  numerical  results  of  simulations  are  plotted  and  listed  in  Figure  4.2,  4.3  and 
Tables  4.1,  4.2,  4.3: 

•  Figure  4.2  is  the  plot  of  joint  variables  solved  with  the  two  methods.  Note 
that  the  3-D  trajectory  of  joint  variables  is  represented  with  two  2-D  plots: 
0i  vs.  03  and  6i  vs.  0S. 

•  On  the  other  hand,  Figure  4.3  shows  actual  trajectories,  with  the  two  meth¬ 
ods,  of  the  end  effector  in  the  workspace,  as  compared  to  the  command 
path.  The  actual  trajectory  was  determined  by  forward  kinematics  with 
joint  values  obtained  by  each  method. 

•  Figure  4.4  shows  the  accuracy  and  corresponding  computational  effort  to 
achieve  it,  with  the  two  methods.  The  task  is  to  reciprocate  a  horizontal 
straight  line.  Again,  the  proposed  formula  was  used  in  conjunction  with 
Taylor’s  algorithm.  Since  the  Resolved  Motion  Method  may  be  viewed  as 
a  one-time  iteration  method,  the  iteration  number  for  this  method  in  the 
figure  is  in  fact  the  number  of  integration  steps  required  to  cover  a  given 
line-segment. 

•  Table  4.1  enables  one  to  numerically  compare  the  accuracy  of  the  tip  loca¬ 
tion,  and  observe  the  irreversibility  factor  due  to  the  homogeneous  solution 
term  of  (3.6),  at  the  transient  period.  For  the  purposes,  we  have  selected, 
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from  the  data  in  Figures  4.2,  4.3,  five  sets  of  data,  which  correspond  to 
the  consecutive  vertices  of  the  square  path  —  counterclockwise  from  the 
upper-left  one,  when  the  tip  begins  to  trace  at  the  very  first  cycle. 

•  Table  4.2  shows  the  comparison  of  the  accuracy  and  repeatability  when 
tracing  opposite  directions  in  the  steady  state.  In  order  to  obtain  the  data, 
the  tip  was  made  to  reciprocate  a  straight  line  segment,  which  was  set  to  the 
left  vertical  side  of  the  square  path,  after  the  first  two  cycles  of  the  square 
path,  when  the  transient  effect  appeared  negligible. 

•  Table  4.3  verifies  the  relationship  proved  in  Appendix  2:  the  solution  with 
the  Resolved  Motion  Method  becomes  equal  to  that  with  the  proposed 
method  after  sufficient  time,  provided  that  dx  =  0.  The  four  vertices  were 
selected  for  the  comparison,  as  in  Table  4.1.  To  obtain  the  data  with  the 
Resolved  Motion  Method,  the  tip  was  commanded  to  stop  at  each  vertex, 
where  it  made  the  self  motion  through  iterations  of  the  homogeneous  term 
of  (3.6),  until  the  joints  converged  to  an  equilibrium  configuration.  At  each 
vertex,  about  25  iterations  were  needed  to  converge  to  the  joint  values  ob¬ 
tained  with  the  proposed  method,  within  the  accuracy  of  10~4  in  degree, 
with  a  =  10,  which  provides  about  the  upper-limit  speed  of  convergence 
without  causing  numerical  instability. 
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Figure  4.2:  Joint  trajectories  obtained  with  the  two  methods:  The  Three  Dimen 
sional  Trajectory  Is  Represented  With  0X  vs.  6j  and  6\  vs.  6$  Trajectories. 
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Figure  4.3:  The  command  path  and  actual  workspace  trajectories 
obtained  with  the  two  methods 
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Figure  4.4:  The  Achievable  Accuracy  Of  Tip-Location  With  The  Two 
Methods  With  Relative  To  The  Iteration  Numbers. 


Table  4.1:  The  comparison  of  accuracy  and  repeatability  obtained 
with  the  two  methods  at  the  first  cycle,  when  transient  effect  is  visible. 


X(mm) 

Y(mm)  (deg) 

02  (deg) 

0s(deg) 

Command  Path 

446.00 

91.514 

Proposed  Method 

446.00 

91.514  -25.5116 

134.4894 

100.8165 

RM  Method 

446.00 

91.514  -40.5006 

141.6408 

78.4169 

Command  Path 

446.00 

-8.4866 

Proposed  Method 

446.00 

-8.4866  -13.4927 

135.1801 

101.6627 

RM  Method 

445.74 

-6.5824  -14.0445 

135.3160 

101.2448 

Command  Path 

546.00 

-8.4866 

Proposed  Method 

546.00 

-8.4863  -7.1232 

128.0020 

92.1837 

RM  Method 

545.52 

-6.8216  -7.1924 

127.9635 

92.4919 

Command  Path 

546.00 

91.514 

Proposed  Method 

546.00 

91.514  -17.0753 

127.4846 

91.4484 

RM  Method 

545.73 

92.947  -17.0519 

127.3890 

91.7938 

Command  Path 

446.00 

91.514 

Proposed  Method 

446.00 

91.514  -25.5116 

134.4894 

100.8165 

RM  Method 

445.97 

93.167  -25.7427 

134.4867 

100.7127 

Table  4.2:  The  comparison  of  accuracy  and  repeatability  obtained 
with  the  two  methods  at  the  steady  state,  when  the  tip  reciprocates 
a  vertical  line-segment. 


X(mm)  Y(mm)  flj(deg)  02(deg)  03(deg) 


Command  Path 

446.00 

91.514 

Proposed  Method 

446.00 

91.514 

-25.5116 

134.4894 

100.8165 

RM  Method 

445.89 

93.140 

-25.7472 

134.4929 

100.7206 

Command  Path 

446.00 

-8.4866 

Proposed  Method 

446.00 

-8.4866 

-13.4927 

135.1801 

101.6627 

RM  Method 

445.63 

-6.6244 

-14.0476 

135.3249 

101.2557 

Command  Path 

446.00 

91.514 

Proposed  Method 

446.00 

91.514 

-25.5116 

134.4894 

100.8165 

RM  Method 

445.60 

92.912 

-25.4178 

134.3821 

101.2799 

Command  Path 

446.00 

-8.4866 

Proposed  Method 

446.00 

-8.4866 

-13.4927 

135.1801 

101.6627 

RM  Method 

445.57 

-6.6184 

-14.0526 

135.3293 

101.2610 

Table  4.3:  The  comparison  of  solutions:  Proposed  Method  vs.  RM 
Method.  For  RM  Method,  self-motion  was  iteratively  made  by  setting 
dx=0. 


X(mm) 

Y(mm)  (deg) 

0a  (deg) 

0s  (deg) 

Command  Path 

446.00 

91.514 

Proposed  Method 

446.00 

91.514  -25.5116 

134.4894 

100.8165 

RM  Method 

446.00 

91.514  -25.5115 

134.4894 

100.8164 

Command  Path 

446.00 

-8.4866 

Proposed  Method 

446.00 

-8.4866  -13.4927 

135.1801 

101.6627 

RM  Method 

446.00 

-8.4868  -13.4927 

135.1801 

101.6626 

Command  Path 

546.00 

-8.4866 

Proposed  Method 

546.00 

-8.4863  -7.1232 

128.0020 

92.1837 

RM  Method 

546.00 

-8.4863  -7.1232 

128.0020 

92.1837 

Command  Path 

546.00 

91.514 

Proposed  Method 

546.00 

91.514  -17.0753 

127.4846 

91.4484 

RM  Method 

546.00 

91.514  -17.0752 

127.4846 

91.4484 

62 


4.5  Discussions 

From  the  results  of  simulations,  we  may  evaluate  the  proposed  method  in  terms 
of  accuracy  and  repeatability  by  comparing  it  with  the  Resolved  Motion  Method. 
We  can  also  derive  some  useful  ideas  from  the  relationship  between  the  two  meth- 


Accuracy 

As  shown  in  Table  4.1  and  Figure  4.3,  the  proposed  method  gives  joint  vari¬ 
ables  which  exactly  correspond  to  the  commanded  z  and  y,  while  maximizing 
the  criteria  function  to  avoid  singularities.  Clearly,  we  see  that  the  accuracy  in 
the  workspace  achieved  with  the  proposed  method  is  better  than  that  with  the 
Resolved  Motion  Method. 

Therefore,  the  proposed  method  provides  useful  means  for  accurate  position 
control  of  the  end-effector,  when  the  manipulator  is  kinematically  redundant. 

Repeatability 

Table  4.2  and  Figure  4.2  show  that  the  repeatability  is  not  preserved  with  the 
Resolved  Motion  Method  because  of  the  two  factors  mentioned  in  Section  3.2.2: 
the  initial  joint  variables  which  are  far  from  optimal  joint  values(Figure  4.2)  and 
the  dependence  on  the  direction,  clockwise  or  counterclockwise,  of  the  path  to  be 
traced  (Table  4.2) . 

On  the  other  hand,  it  is  obvious  that  the  proposed  method  preserves  the  re¬ 
peatability  regardless  of  direction.  In  other  words,  the  method  provides  a  fixed 
transformation  from  workspace  to  joint  space.  The  property  of  fixed  transfor¬ 
mation  is  useful  not  only  for  the  prediction  of  joint  variables,  but  also  for  the 
precomputation  of  position  dependent  terms  such  as  the  Jacobian  matrix  and  the 
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inertia  matrix  (Raibert  and  Horn, 1978). 

Computational  Effort 

As  mentioned  before,  the  comparison  of  computational  efficiency  was  made  in  two 
situations:  when  solving  the  steady  state  equilibrium  states  with  fixed  tip  loca¬ 
tion,  and  when  obtaining  joint  trajectories  with  tip  moving  along  the  Cartesian 
path.  The  two  cases  will  be  discussed  separately. 

For  Equilibrium  State 

The  number  of  iterations  to  achieve  the  accuracy  of  10-4  in  degree  by  the  proposed 
method  with  MINPACK-1  is  about  from  10.  On  the  other  hand,  the  number  of 
iterations  required  for  the  same  accuracy  by  the  Resolved  Motion  Method  is  about 
25  1  —  thus  about  2.5  times  more  iterations  than  the  proposed  formula. 

It  is  not  immediately  clear  how  the  two  method  will  compare  for  manipulators 
with  more  degrees  of  freedom.  Yet,  we  expect  the  Resolved  Motion  Method 
would  require  a  similarly  larger  computational  effort  than  the  proposed  method, 
considering  the  following  factors: 

•  As  quoted  in  Section  2.4.3,  the  proposed  formula  requires  about  15  iterations 
for  manipulators  with  up  to  none  degrees  of  freedom-  At  the  same  time,  it  is 
not  quite  probable  that  the  Resolved  Motion  Method  requires  less  iterations 
for  more  degrees  of  freedom  case; 

•  Moreover  the  former  requires  about  43%  more  computation  per  iteration 
than  the  latter. 

For  Trajectory  Generation 

lTh is  number  is  based  on  the  Runge-Kutta  method.  An  efficient  step-sise  control  with  the 
predictor-corrector  method  may  reduce  the  number  of  iterations. 


From  the  simulations,  it  turned  out  to  be  the  deviation  with  the  Resolved  Mo¬ 
tion  Method  is  nearly  proportional  to  the  length  of  equidistant  segments.  This 
length  in  turn  is  directly  proportional  to  the  number  of  integration  steps,  N,itp , 
or  equivalently  computational  efforts.  In  other  words,  for  a  given  straight  line 
segment,  Ax,  the  number  of  integration  steps,  or  iteration  number,  is  estimated 
as, 

N  -!1A 

ly  itep  ~  77T" 

11*1 

where  x  is  the  speed  of  the  tip  motion,  6t  the  integration  time  step,  and  ||.|| 
represents  the  Euclidean  norm  of  vectors.  We  can  reduce,  of  course,  N,tep  by 
increasing  the  speed  of  tip  motion  and  time  step  at  the  cost  of  accuracy  and 
numerical  stability. 

On  the  other  hand,  the  deviation  with  the  proposed  formula,  if  Taylor’s  algo¬ 
rithm  is  used,  decreases  exponentially  with  a  base  of  2  to  4  as  the  length  between 
two  via  points  halves  —  by  adding  one  via  point  in  the  middle.  Figure  4.5  shows 
the  change  of  deviation  as  via  points  changes. 

Thus,  as  Figure  4.4  shows,  with  sparse  via  points,  the  deviation  resulting  from 
the  Resolved  Motion  Method  is  smaller  than  that  with  the  proposed  method, 
provided  the  same  computational  effort  is  applied.  When  the  via  points  become 
more  than  a  certain  number,  the  situation  reverses.  In  the  simulation,  the  break 
point  is  when  the  number  of  via  points  for  the  proposed  method  becomes  about 
17,  where  the  deviation  is  about  30mm,  assuming  total  sum  of  lengths  of  links  is 
lm. 

Since  the  proposed  method  requires  about  9  iterations  for  a  via  point,  the 
total  number  of  iterations  is  about  160.  Hence,  if  the  accuracy  required  is  within 
a  deviation  of  less  than  30mm  per  average  link  length  of  lm,  the  proposed  method 
gives  more  accurate  trajectory  than  the  Resolved  Motion  Method. 

In  the  case  for  more  degrees  of  freedom  manipulators,  the  comparison  is  ex- 
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Tip  Location  Error  Due  to  Joint  Interpolation 
Figure  4.5:  The  Change  of  Deviation  From  the  Desired  Path,  As  the 

Via  Points  Changes.  Note  That  The  Deviation  Is  Changing  Expo¬ 
nentially. 


pected  to  be  similar,  because  of  almost  the  same  reasonings  made  above,  when 
the  equilibrium  state  case  was  considered. 

Relationship  between  the  Two  Methods 

The  result  in  Table  4.3  shows  a  nearly  perfect  agreement  of  both  solutions,  ver¬ 
ifying  that  (2.11)  in  the  proposed  method  is  the  equilibrium  equation  at  which 
(3.5)  will  finally  arrive. 

Because  of  the  relationship  between  the  two  methods,  we  may  use  them  in¬ 
terchangeably  as  follows: 

•  The  exact  equilibrium  state  can  be  determined  either  with  the  proposed 
method,  or  with  the  Resolved  Motion  Method  by  setting  dx  =  0.  The  latter, 
however,  would  require  more  computations  than  the  former,  as  discussed 
before. 

•  The  incremental  displacement  dt ,  which  (3.5)  of  the  Resolved  Motion  Method 
easily  provides,  can  be  also  obtained  by  using  (3.10). 


Chapter  5 

Development  of  A  Dexterity 
Measure 


5.1  Introduction 

The  benefits  of  using  a  quantitative  measure  in  engineering  systems  are  well 
known.  As  mentioned  in  Section  1.1.3,  a  quantitative  measure  provide  us  with 
a  rational  basis  upon  which  we  can,  without  having  to  rely  on  experience  and 
intuition  alone,  analyze,  design,  and  control  the  systems. 

In  robot  systems,  too,  various  performance  measures  have  been  tried,  which 
were  listed  in  Chapter  1.  In  the  subsequent  chapters,  these  measures,  in  a  generic 
form  denoted  as  H ,  have  been  taken  into  account,  when  using  kinematic  control 
methods  for  redundant  manipulators. 

In  this  chapter  and  next,  we  focus  on  a  certain  desired  performance,  dexterous 
configuration,  and  develop  a  corresponding  measure,  dexterity  measure.  This 
performance,  however,  becomes  in  fact  quite  ambiguous  unless  the  concept  of 
dexterity  is  more  precisely  defined.  The  concept  of  dexterity,  when  proposed  by 
Klein(1984),  appeared  to  mean  (l)the  goodness  of  linear  system  of  the  differential 


relationship,  as  indicated  by  the  determinant  or  condition  number  of  the  Jacobian 
matrix;  or  (2)a  natural  appearance  resulting  from  evenly  distributed  joint  angles, 
represented  by  summing  the  squares  of  the  deviation  of  actuators  displacements 
from  their  midpoint. 

According  to  this  definition,  the  least  dexterous  configuration  would  be  proba¬ 
bly  the  singular  configuration;  for  at  singularity  not  only  is  the  condition  of  linear 
system  at  its  worst,  but  also  awkward  appearances  happen  owing  to  lining-up  or 
folding  of  links.  In  this  sense,  therefore,  dexterity  may  be  viewed  as  a  degree  of 
farness  or  distance  from  singularity.  In  the  thesis,  the  meaning  of  dexterity  is 
explicitly  specified  as  the  distance  from  singularity. 

The  distance  from  singularity,  as  mentioned  in  Section  1.1.3,  may  be  repre¬ 
sented  with  one  of  the  following  measures  derived  from  the  Jacobian  matrix:  the 
determinant(or  the  manipulability  measure  for  the  redundant  case),  the  condi¬ 
tion  number,  and  the  singular  values.  Yet,  in  the  case  of  redundant  manipula¬ 
tors,  it  was  discussed  that  these  measures  cannot  explicitly  indicate  the  successive 
changes  in  the  degree  of  redundancy.  This  inability  to  indicate  its  change,  consid¬ 
ering  that  the  degree  of  redundancy  is  an  important  constituent  of  the  distance 
from  singularity,  is  an  obvious  shortcoming  for  distance  measures.  Furthermore, 
even  for  a  particular  degree  of  redundancy,  there  appear  relative  differences  in 
the  distance  from  singularity  that  have  been  unnoticed.  Therefore,  we  feel  that 
a  satisfactory  dexterity  measure  should  not  only  include  the  feature  of  indicating 
the  change  in  the  degrees  of  redundancy,  but  also  represent  relative  differences  in 
a  particular  degree  of  redundancy. 

In  order  to  better  understand  the  degree  of  redundancy  and  the  relative  dif¬ 
ferences,  we  first  review  in  Section  5.2,  the  concept  of  singularity,  and  some  basic 
knowledges  about  the  degree  of  redundancy.  Then,  in  Section  5.3,  we  derive  a 
new  concept  from  observation  of  redundant  manipulators.  From  this  concept,  a 


new  performance  measure  will  be  developed  in  Section  5.4.  The  property  of  this 
measure  will  be  discussed  in  Section  5.5.  Finally  some  concluding  remarks  will 
be  made  in  Section  5.6. 


5.2  Review  of  Singularity  and  Redundancy 

This  section  presents  reviews  on  two  basic  concepts,  singularity  and  kinematic 
redundancy,  which  are  necessary  for  better  understanding  the  distance  from  sin¬ 
gularity  in  the  redundant  manipulators. 

5.2.1  Singularity 

1  Singularities  can  be  easily  observed  by  examining  the  differential  relationship, 
(3.2),  which  is  again, 

x=J0  (5.1) 

where  0  is  n-dimensional  vector  representing  joint  variables,  x  is  m-dimensional 
vector  representing  end  effector  location. 

For  the  nonredundant  case(n  =  m),  the  Jacobian  matrix  J  is  a  square  ma¬ 
trix.  When  the  Jacobian  matrix  becomes  singular,  a  manipulator  is  said  to  be  at 
singular  point. 

Hence  at  singular  point,  the  determinant  of  J,  det(J)  equals  zero.  This  simple 
fact,  toother  with  the  fact  that  the  determinant  is  a  continuous  function  of  joint 
variables,  provides  with  some  important  insights: 

1.  When  det(J)  --  0,  the  rank  of  J  being  reduced,  the  arm  loses  corresponding 
degrees  of  freedom,  with  the  results  that  it  cannot  move  in  some  directions 
by  any  combinations  of  small  motions  in  the  joints. 

‘Much  of  discussions  lien?  is  based  on  the  personal  note  on  singularity  by  Professor  B.K.P. 
Horn,  the  author's  supervisor. 
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2.  Thus,  as  arm  approaching  this  point,  small  movements  in  those  directions 


require  very  large  displacements  in  joint  space. 

3.  At  singular  points,  since  the  determinant  is  a  continuous  function,  its  sign 
changes.  The  change  of  sign,  considering  the  determinant  is  the  ratio  of 
differential  volume  of  Cartesian  coordinates  to  that  of  joint  coordinates, 
indicates  a  change  from  one  kind  of  solution  to  another.  In  fact,  just  as 
a  change  of  sign  in  a  continuous  function  cannot  occur  without  passing 
through  zero,  so  the  arm  cannot  change  from  one  kind  of  solution  to  another 
without  passing  through  singularity.  This  property  was  also  discussed  in 
(Uchiyama,1979) 

4.  At  a  singularity,  thus,  two  different  kinds  of  solution  become  one  kind; 
hence,  the  number  of  different  solutions  is  reduced. 

5.  Items  3  and  4  can  be  explained  in  terms  of  Riemann  sheets:  multiple  solu¬ 
tions  correspond  to  multiple  sheets  each  of  which  represents  the  mapping 
from  joint  angles  to  Cartesian  coordinates;  and  singular  points  correspond 
to  the  folds. 

The  first  two  items,  by  the  way,  may  explain  why  keeping  far  from  singularity  is 
closely  related  to  dexterity. 

From  the  fact  that  the  determinant  becomes  zero  at  singularity,  it  functions  in 
a  sense,  as  an  indicator  of  the  presence  of  a  singular  point.  Besides,  the  absolute 
value  of  the  determinant,  if  geometrically  interpreted,  represents  the  volume  of 
parallelepiped  made  of  n  column  vectors  (or  row  vectors)  of  the  Jacobian  matrix. 
This  interpretation,  together  with  the  fact  that  at  singularity  the  parallelepiped 
collapses  and  the  volume  becomes  zero,  is  in  fact  the  basis  of  the  idea  that  the 
determinant  is  a  measure  of  distance  from  singularity. 
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One  disadvantage  of  using  determinant,  however,  as  an  indicator  of  singular¬ 


ity  is  that,  once  the  rank  of  J  is  reduced,  it  does  not  distinguish  between  one 
state  of  singularity  and  another  although  their  remaining  ranks  are  different;  the 
determinants  of  both  of  them  are  equally  zero.  The  more  accurate  indicator  for 


this  purpose  would  be  probably  the  remaining  rank,  or  degree  of  freedom,  itself. 


For  redundant  manipulators,  it  was  pointed  out  in  Section  1.1.3  that  the 


measure  equivalent  to  det(J)  is  the  manipulability  measure,  det( JJr).  Yet,  this 


measure,  as  mentioned  in  Section  5.1,  cannot  indicate  the  change  in  the  degrees 


of  redundancy,  which  will  be  reviewed  in  the  following  subsection. 


5.2.2  Kinematic  Redundancy 


The  degree  of  redundancy  r  is  formally  defined  as 


r  ~  n  -  m 


where  n  is  the  degree  of  freedom,  and  m  the  rank  of  workspace.  In  linear  algebra 
(Strang, 1980),  the  degree  of  redundancy  corresponds  to  the  dimension  of  null 


space  of  the  Jacobian  matrix,  the  degree  of  freedom  to  the  dimension  of  its  column 


space,  and  the  workspace  rank  to  the  dimension  of  its  row  space.  In  other  words. 


the  degree  of  redundancy  is  the  maximum  number  of  linearly  independent  vectors 


in  the  null  space,  e, ,  defined  as 


Je,  =  0 


But,  we  find  that  this  definition  is  not  sufficient  for  describing  the  concept  of 


redundancy. 


For  instance,  consider  the  following  Jacobian  matrix  representing  a  three  de¬ 


grees  of  freedom  planar  redundant  manipulator  consisting  of  three  two-dimensional 


column  vectors,  J1,  J2,  and  J3  as 


J  (J1  J2  J3). 


If  the  second  and  the  third  links  line  up,  that  is  J3  =  cJ 2  with  c  any  nonzero 
constant,  we  know  we  do  not  have  any  redundancy  left.  However,  the  null  space 
vector  that  satisfies  (5.3)  is  obtained  as 


e  -  (0  c  -  1), 

which  is  a  nonzero  vector.  Thus,  according  to  the  definition,  the  degree  of  redun¬ 
dancy  is  one,  whereas  the  observation  indicates  there  is  no  redundancy.  Then,  how 
can  we  explain  this  difference?  The  discrepancy  can  be  resolved  if  we  modify  the 
meaning  of  n  in  (5.2),  as  the  available  degrees  of  freedom.  But,  as  mentioned  in 
Section  5.1,  it  turns  out  that  this  modified  definition  is  still  inadequate  to  describe 
the  relative  differences  in  the  distance  within  the  same  degree  of  redundancy. 

5.3  A  New  Concept  of  Distance  from  Singular¬ 
ity  in  Redundant  Case 

In  this  section,  we  will  observe  some  Jacobian  matrices  of  kinematically  redundant 
manipulators,  and  identify  relative  differences  in  the  distance  from  singularity.  On 
the  basis  of  the  observations,  we  will  propose  a  new  definition  of  the  distance  from 
singularity. 

Again,  the  kinematic  equation  of  a  kinematically  redundant  manipulator  is 
generally  given  as  follows: 

x  =  f  (#) 

where  x  €  9tm,  and  0  €  l R"  with  with  men.  Then,  tf.-;  Jacobian  matrix  from 
the  equation,  which  is  given  as  J  €  SRmxn,  may  be  denoted  in  general  as, 

where  Jk  is  &-th  column  vector.  If  m  linearly  independent  vectors  are  chosen, 
without  loss  of  generality,  as  the  first  m  column  vectors  of  J,  then,  from  linear  al- 
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gebra,  the  remaining  n  -m  vectors  Jm+l  ,..,Jn  are  linear  combinations  of  Jl 
(Strang, 1980). 

Observations  show  that  how  many  of  these  m  vectors  are  included  in  the 
linear  combination  for  each  of  the  remaining  n  -  m  vectors  determines  how  far 
from  singularity  a  given  configuration  of  the  manipulator  is  at  the  moment. 

To  illustrate  the  point,  let  us  select  a  manipulator  with  one  degree  of  redun¬ 
dancy,  i.e.,  n  —  m  ~  1,  where 

J  =  [J\ Jm+1] 

Consider  the  following  three  cases  of  linear  combinations  for  Jm+l : 

1.  Jm =  a,J‘ 

2.  Jm'x  —  aiJ1  +  a-zJ1 

3.  JmTi  —  a\Jx  -f-  a-zJ*  -f  ...  +  amJm 

where  a,’s,  (i  =  l,2,..,m)  are  arbitrary  nonzero  constants.  What  are  then  the 
differences  among  these  cases? 

According  to  the  formal  definition  in  (5.2),  the  degrees  of  redundancy  for  the 
three  cases  are  the  same,  one.  Alternatively,  if  the  modified  definition  is  used, 
then  the  manipulator  in  Case  1  has  no  redundancy,  whereas  those  in  Cases  2  and 
3  have  equally  one  degree  of  redundancy.  However,  a  careful  observation  reveals 
that  there  still  exists  another  difference  in  the  distance  from  singularity  between 
Cases  2  and  3.  The  differences  among  the  three  cases  may  be  explained  as  follows: 

1.  In  Case  1,  the  manipulator  gets  into  singularity,  reducing  its  rank  (<  m),  if 
any  two  of  the  first  m  column  vectors  happen  to  line  up. 

2.  In  Case  2,  singularity  arises  if  any  two,  except  for  J1  and  J2,  of  the  m 
column  vectors  line  up. 
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3.  In  Case  3,  it  preserves  its  rank  (=  m),  although  any  two  of  the  column 
vectors  happen  to  line  up. 

In  other  words,  the  chance  for  the  manipulator  to  get  into  singularity  decreases 
by  degrees,  as  the  number  of  linearly  independent  vectors  to  be  included  in  the 
combination  increases.  These  differences  in  chances  of  getting  into  singularity 
make  the  relative  differences,  within  the  same  degrees  of  redundancy,  in  the  dis¬ 
tance  from  singularity.  Meanwhile,  how  many  of  J1  ,J2 ,  ..Jm  appear  in  each  of 
uniquely  determines  the  number  of  distinct  combinations  of  m  lin¬ 
early  independent  column  vectors,  or  the  number  of  distinct  submatrices  of  rank 
m  in  the  Jacobian  matrix.  Hence,  this  number  of  submatrices  also  represents  the 
margin  from  singularity;  the  larger  the  number,  the  less  is  the  chance  of  getting 
into  singularity.  Of  course,  the  number  reduces  successively  as  the  number  of 
lining-up  of  column  vectors  increases.  Of  the  equivalent  two,  to  determine  the 
number  of  submatrices  would  be  much  easier  than  to  select  m  vectors  and  to 
examine  how  many  of  the  m  vectors  are  included  in  the  remaining  n  -  m  vectors. 
Note,  at  the  same  time,  that  the  observation  is  not  confined  to  this  particular 
example  of  one  degree  of  redundancy  case,  but  evidently  true  for  general  cases, 
where  the  degree  of  redundancy  is  more  than  one. 

As  another  example,  consider  the  following  five  jointed  robot  having  a  three 
dimensional  workspace  and  thus  two  degrees  of  redundancy,  where  the  Jacobian 
matrix  is  given  as, 

j  -  [j1j2j3j4j5 | 

where  J,’s  are  again  the  three  dimensional  column  vectors.  If  Jl,J 2,  and  J3  are 
selected  as  linearly  independent  vectors,  then  J*  and  J5  are,  in  general,  repre¬ 
sented  as 

J4  =  exJl  +  c2J 2  +c3J3 

J 5  —  d\J^  +  d-2J 2  -f  d^J^ 
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Depending  on  how  many  and  which  of  c,’s  and  d,'s  are  zero,  we  have  different 
numbers  and  combinations  of  linearly  independent  vectors  appearing  in  J 4  and 
J s.  At  the  same  time,  this  number  and  combination  of  vectors  determine  the 
number  of  submatrices  of  rank  3  in  the  Jacobian  matrix.  The  Table  5.1  shows 
the  relationship  between  the  number  of  submatrices  and  the  number(and  the 
combination)  of  linearly  independent  vectors. 

It  is  noteworthy  that  the  number  of  submatrices  successively  reduces  from  the 
maximum,  10,  to  the  minimum,  1,  depending  on  the  number  and  combination  of 
linearly  independent  vectors.  Again,  even  within  the  same  degree  of  redundancy, 
there  are  different  number  of  submatrices.  Clearly  this  number  of  submatrices 
differentiates  the  relative  distance  from  singularity. 

In  addition,  note  that  the  absolute  value  of  determinant  of  each  submatrix, 
called  minor ,  represents  the  distance  from  its  own  degenerating  state.  Therefore, 
the  overall  distance  with  relative  to  singularity  should  consider  the  value  of  each 
minor  of  the  Jacobian  matrix.  In  other  words,  in  addition  to  the  number  of 
submatrices  of  rank  m,  the  chance  of  singularity  is  even  less,  as  each  submatrix  is 
farther  from  singularity,  that  is,  as  each  minor  has  larger  absolute  value. 

The  above  observations  directly  lead  to  a  definition  of  distance  from  singularity 
as  follows: 

Definition 

The  distance  from  singularity  is  represented  as  the  number  of  distinct 
nonsingular  submatrices  of  rank  m  and  the  magnitude  of  determinant 
of  each  submatrix,  or  the  magnitude  of  each  minor  of  the  Jacobian 
matrix. _ 


5.4  The  Derivation  of  A  New  Performance  Mea- 


{ 


sure 

In  this  section,  on  the  basis  of  the  distance  concept  developed,  we  will  derive  a 
performance  measure  for  the  kinematic  control  purpose.  More  specifically,  from 
the  concept  the  following  objectives  are  to  be  met  to  achieve  the  desired  perfor- 


•  to  keep  the  number  of  distinct  nonsingular  submatrices  of  rank 
m  as  large  as  possible; 

•  to  make,  and  at  the  same  time,  the  magnitude  of  each  minor  as 
large  as  possible. 

i _ 

As  an  index  that  explicitly  represents  these  objectives,  we  propose  the  follow¬ 


ing  measure: 


H=  IlA. 


where  A.'s  for  i  -  1,2,  ..,p,  with  p  =  nCm,  are  minors  of  rank  m  of  the  Jacobian 
matrix.  Clearly,  this  measure  contains  in  its  expression  the  two  elements  of  the 
distance,  the  number  and  the  magnitude  of  distinct  minors,  in  such  a  way  that 
its  increase  automatically  achieves  the  above  two  objectives.  To  be  more  specific, 
since  the  measure  has  nonzero  values  only  if  all  of  the  minors  are  nonzero,  keeping 
it  greater  than  zero  guarantees  the  maximum  number  of  distinct  submatrices.  At 
the  same  time,  since  the  measure  cannot  have  a  large  value  unless  each  minor  is 
large,  increasing  the  measure  tends  to  increase  the  magnitude  of  each,  as  a  whole. 
Furthermore,  since  the  measure,  being  a  product,  becomes  smaller  if  the  minors 
have  uneven  values  —  some  too  large  and  some  too  small  —  it  prevents  any  minor 
from  being  dominantly  large  at  the  cost  of  forcing  others  to  be  too  small. 
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In  (5.4),  the  exponent  I/p  is  primarily  used  so  that,  when  n  —  m,  the  measure 
might  reduce  to  the  absolute  value  of  determinant.  We  find  a  similar  treatment, 
in  (Yoshikawa.1984),  where  the  manipulability  measure  is  defined  by  applying 
the  exponent  of  1/2  to  det( JJr).  Of  course,  if  exponents  are  used,  then  physical 
interpretations  for  the  measure  become  different.  About  this,  we  will  discuss 
more  in  the  following  section.  Besides,  the  use  of  an  exponent,  when  the  measure 
is  used  in  the  null  space  of  Resolved  Motion  Method,  results  in  a  different  time 
response  of  convergence  toward  the  optimal  joint  configuration.  Except  for  these, 
the  essential  characteristics  are  not  changed. 

5.5  The  Property  of  The  Measure 

Examining  the  new  measure,  we  find  the  following  important  properties: 

•  When  m  =  n,  i.e.,  for  nonredundant  manipulators,  the  measure  reduces  to 

H  -  |def(J)| 

which  is  the  same  as  that  proposed  by  (Paul  and  Stevenson, 1983).  From  a 
property  of  the  determinant,  the  measure  is  conceptually  interpreted  as  the 
volume  of  a  parallelepiped  in  m-dimensional  space,  the  edges  of  which  come 
from  the  rows  —  or  equivalently  columns  —  of  the  Jacobian  matrix,  J. 

•  When  n  >  m,  thus,  the  measure  represents  the  geometric  mean  of  the 
volumes  of  p  parallelepipeds  made  of  each  combination  of  m  column  vectors 
out  of  n. 

•  The  points  where  A,  =  0  determine  the  boundary  between  one  kind  of 
joint  configuration(or  solution)  and  another  kind.  These  points  are  also  the 
points  where  some  of  the  column  vectors  in  A,  are  linear  combinations  of 
the  remaining  ones  in  A,,  and  thereby  causing  the  minor  to  become  zero. 
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Note  that  the  last  property  may  be  considered  an  extension,  to  the  redun¬ 
dant  case,  of  the  nonredundant  case  in  Section  5.2,  where  the  points  satisfying 
det(J)  =  0  determines  boundaries.  This  property  in  fact  was  used  by  Borre!  and 
Liegeois(Borrel,1986)  to  determine  the  boundaries  of  different  kinds  of  joint  solu¬ 
tions.  These  boundaries  then  divide  the  joint  space  into  subsets,  called  aspects , 
each  of  which  consists  of  the  kind  of  joint  solution  or  configuration. 

In  addition  to  determining  aspects,  by  using  this  property,  we  can  make  the 
joint  configuration  stay  within  a  preferred  aspect.  More  specifically,  by  keeping 
A,  from  zero,  we  preserve  the  kind  of  joint  solutions  for  redundant  manipulators. 

Then  why  do  we  need  to  make  the  joint  configuration  stay  within  an  aspect? 
Some  of  the  reasons  have  been  mentioned  in  Section  3.2.2,  Section  5.2,  and  Sec¬ 
tion  1.1.3,  which  are  summarized  as  the  following: 

•  The  switching  of  aspects  can  cause  a  kind  of  repeatability  problem. 

•  When  the  switching  occurs,  discontinuity  in  motion  and  awkward  configu¬ 
rations  may  accompany. 

Clearly,  now  that  maximizing  the  performance  measure  directly  prevents  A, 
from  zero,  it  immediately  aims  at  these  problems.  In  other  words,  by  virtue  of 
its  property,  the  new  performance  measure  is  expected  to  help  solve  these.  How 
the  measure  achieves  the  expected  performances  is  one  of  the  main  issues  in  the 
following  chapter. 

5.6  Conclusion 

To  sum  up,  we  have  defined  the  desired  performance,  the  dexterous  configuration, 
and  developed  the  concept  of  the  distance  with  relative  to  singularity  for  redun¬ 
dant  manipulators.  On  the  basis  of  this  concept  we  derived  a  new  performance 
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measure  to  help  achieve  the  performance.  In  addition,  from  the  analysis  of  the 
properties  of  the  measure,  we  expect  that  the  measure  may  i>e  useful  for  prevent¬ 
ing  the  repeatability  problem  and  other  problems  due  to  switching  of  aspects. 


Table  5.1:  The  relationship  between  the  number  of  linearly  indepen¬ 
dent  vectors  in  representing  the  remaining  vectors  and  the  number  of 
submatrices  in  the  Jacobian  matrix. 


c,  c2  C3 

d\  d2  d3 

— 

*  *  * 

*  *  * 

*  *  * 

0  *  * 

0  0  * 

*  *  * 

0  *  * 

*  *  0 

0  0  * 

*  *  0 

0  *  * 

q  *  * 

No.  of  sub- 

10 

9 

8 

8 

7 

6 

matrices 

(5C3) 

Notes: 

A 

B 

C 

D 

E 

Ci  c2  c3 

0  0  * 

0  0  * 

0  0  0 

0  *  0 

0  0  0 

0  0  0 

d\  d2  d3 

0  *  * 

*  0  0 

*  +  * 

0  +  0 

0  *  0 

0  0  0 

No.  of  sub- 

5 

4 

4 

3 

2 

1 

matrices 

Notes: 

G 

H 

_ 

I 

J 

K 

L 

1 

*  represent  any  nonzero  value 


Notes: 

A  All  of  c,’s  and  d,’s  are  nonzero. 

B  Only  one  among  c, ’s  and  d,’ s  is  zero. 

C  Any  two  of  either  c,’s  or  d,’ s  zero. 

D  One  of  c,’s  and  one  of  d/s  are  zero  with  i  #  j. 

E  Two  of  either  c,'s  or  d,’s  are  zero  and  one  of  the  other  parts,  d; ’s  or  c;’s,  is  zero  with 

*  #  J 

F  One  of  c,’s  and  one  of  d,’ s  are  zero  with  i  —  j. 

G  Two  of  either  c,’s  or  d,’ s  are  zero  and  one  of  the  other  parts,  d}' s  or  c;’s,  is  zero  with 
i  =  j. 

H  Two  of  both  c,'s  and  d}’s  are  zero,  with  one  overlapping  i  —  J. 

I  All  of  either  c,  ’s  or  d;’s  are  zero. 

J  One  of  both  c,  s  and  d/ s  are  nonzero,  with  i  -  J 
K  Only  one  of  either  c,'s  or  d/s  is  nonzero. 

L  All  of  c,' s  and  d,  s  are  zero. 
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Chapter  6 

Relationship  and  Comparison 
with  other  Measures 


6.1  Introduction 

In  this  chapter,  we  test  the  new  performance  measure  developed  in  the  previous 
chapter  in  order  to  see  if  it  indeed  helps  achieve  the  desire  performance.  Also  we 
will  examine  if  it  has  the  ability  of  avoiding  repeatability  problem  and  problems 
due  to  switching  of  the  kinds  of  solutions. 

To  this  end,  first,  we  investigate  the  qualitative  relationships  of  the  new  mea¬ 
sure  with  two  major  performance  measures  introduced  in  Section  1.1.3:  the  ma- 
nipulability  measure  and  the  condition  number.  We  will  also  focus  on  the  afore¬ 
mentioned  property  of  preventing  the  switching  of  aspects.  Then,  we  will  try 
to  confirm,  through  numerical  simulations  for  three  different  manipulating  situa¬ 
tions,  the  points  so  far  derived. 
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6.2  Relationship  with  Other  measures 

In  this  section,  we  investigate  the  relationship  between  the  proposed  measure  and 
each  of  the  two  measures:  first  the  manipulability  measure  and  then  the  condition 
number. 


6.2.1  the  relationship  to  the  manipulability  measure 

From  the  fact  that  both  represent  the  distance  from  singularity,  we  intuitively 
see  that  the  new  measure  and  the  manipulability  measure  are  somewhat  related 
to  each  other.  However,  what  is  more  precise  relationship  between  the  two?  The 
following  theorem  answers  the  question: 

Theorem  3  For  any  matrix,  J  €  SRmxn,  with  m  <  n, 

det( JJr)  =  £  A,2 

i=l 

where  A i’s,  i  =  l,2,.,,p,  with  p  =  nCm,  are  again  minors  of  rank  m  of  the 
matrix  J. 

The  proof  for  the  theorem  is  in  Appendix  4.  Since  the  manipulability  measure, 
Hi ,  is  defined  as 

Hi  =  yJdet(3JT) 

it  is  expressed  in  terms  of  minors  as  follows: 

Hi  =  ,Ea.>  (6.1) 

N  «=i 

whereas  the  new  measure  expressed  in  (5.4)  is  again, 

|  p  1/p 

h  =  n  a, 


Comparing  the  two  measures,  we  note  the  following  differences: 
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1.  Geometrically,  the  manipulability  measure  may  be  interpreted  as  the  Eu¬ 
clidean  norm  of  the  vector  representing  the  present  state  in  the  Ai  —  Aj  — 

•  •  •  —  Ap  coordinates  system,  or  as  the  distance  from  the  origin  to  the 
present  state  in  that  coordinate  system.  The  new  measure,  on  the  other 
hand,  represents  the  radius  of  sphere  whose  volume  is  equal  to  that  of  the 
hyper-hexahedron  made  from  the  A,,  »  =  1, 2,  •  •  • ,  p  coordinates  in  the  same 
coordinate  system. 

2.  As  mentioned  in  Section  5.5,  the  new  measure  cannot  have  a  large  value 
if  the  value  of  each  Aj  is  uneven;  whereas  the  other  can  have  still  a  large 
value  only  if  some  of  dominant  minors  have  large  values.  The  manipula¬ 
bility  measure  can  have,  in  the  extreme,  some  zero  minors,  as  long  as  the 
workspace  rank  is  preserved. 

Hence  the  new  measure  tends  to  give  more  balanced  minors  than  the  ma¬ 
nipulability  measure,  not  to  mention  prevents  minors  from  being  zero,  thus 
directly  controlling  over  switching  of  aspects;  whereas  the  manipulability 
measure  does  not  have  an  immediate  effect  on  switching  of  aspects. 

3.  Note  that  the  manipulability  can  be  also  expressed  as(Yoshikawa,1985) 

k 

where  o*  is  the  k  —  th  singular  value. 

This  expression  shows  that  the  measure  has  exactly  the  same  form  as  the 
new  measure  in  that  it  is  a  product;  the  difference  is  that  the  manipulabil¬ 
ity  measure  is  the  product  of  the  singular  values  representing  workspace, 
whereas  the  new  measure  the  product  of  minors  representing  the  joint  space. 

This  difference  implies,  in  a  sense,  that  the  former  concentrates  on  pre¬ 
serving  the  workspace  rank  while  the  latter  on  degrees  of  freedom  of  joint 


space.  Since  keeping  maximum  degrees  of  freedom  of  joint  space  automat¬ 
ically  preserves  the  workspace  rank,  the  latter  has  the  more  sufficient  yet 
strict  requirements. 

To  illustrate  the  second  difference,  let  us  consider  the  same  redundant  manip¬ 
ulator  in  Chapter  4,  which  is  to  locate  the  end  effector  at  a  certain  x  —  y  position. 
At  the  end  effector  location,  there  exist  infinite  numbers  of  configurations  or  sets 
of  joint  values  that  enable  the  position,  each  determining  a  distinct  Jacobian 
matrix  and  thus  a  distinct  set  of  minors. 

These  sets  of  minors  accordingly  determine  a  curve  in  the  Ai  —  A2  —  A3  coor¬ 
dinate  system,  as  shown  in  Figure  6.1.  Applying  the  proposed  method  for  inverse 
kinematics,  when  the  end  effector  is  located  at  x  =  0.2 m  y  =  0 m,  we  can  obtain 
two  sets  of  joint  values  that  maximizes  the  two  measures.  Then  their  correspond¬ 
ing  sets  of  minors  are  plotted  in  the  same  curve  in  Figure  6.1.  From  the  resulting 
minor  values  plotted  in  the  figure,  one  may  confirm  the  predicted  tendency:  the 
new  performance  measure  gives  somewhat  more  balanced  minor  values  than  the 
manipuiability  measure.  This  tendency  was  also  confirmed,  although  different  in 
degrees  depending  on  the  locations  within  the  workspace:  the  more  noticeable  as 
the  tip  moves  toward  the  outer  or  inner  workspace  limits. 


i 

it 

.♦ 


6.2.2  Relationship  with  the  condition  number 

The  relationship  with  the  condition  number,  however,  is  not  so  clear  as  that  with 
the  manipuiability  measure,  because  of  the  difficulty  in  deriving  such  a  pair  of 
simple  expressions  as  (5.4)  and  (6.1).  As  well  known,  the  condition  number  H2  is 
defined  as 

Hi  =  (6.2) 

&min 

where  Omin  and  are  minimum  and  maximum  values  of  singular  values,  respec¬ 
tively.  As  pointed  out  in  the  above  subsection,  since  the  singular  values  represent 


0.20  p2  +  +  The  New  Measure 

0.1  s\-  *  *  The  Manipulability 


Cross  Plot  of  Minor  Trajectory:  J1  vs.  J3 

Figure  6.1:  Trajectories  of  Minors  under  the  constraint  of  Kinematic  Equation, 
When  the  tip  is  at  x  =  0.2,  y  =  0;  and  Two  Optimal  Configurations  with  relative  to 
the  Two  Performance  Measure:  The  Three  Dimensional  Trajectory  Is  Represented 
With  Ai  vs.  Aj  and  Aj  vs.  Aj  Trajectories. 


the  workspace  rank,  this  measure,  too,  concentrates  its  concern  on  preserving  the 
workspace  rank.  More  specifically,  minimizing  the  condition  number,  in  effect, 
results  in  maximizing  ami„.  Since  nonzero  value  of  amin  guarantees  the  workspace 
rank,  the  measure  after  all  tries  to  preserve  the  workspace  rank.  And  as  long 
as  it  is  preserved,  it  does  not  concern  about  what  happens  within  the  redundant 
degrees  of  freedom. 


6.3  Comparison  of  Performance  measures 

In  this  section,  the  new  measure  is  quantitatively  compared  with  the  two  other 
measures.  To  this  end,  some  numerical  experiments  are  tried  for  the  case  of  a 
three  degrees  of  freedom  planar  manipulator  as  in  Chapter  4. 

The  points  we  try  to  examine  through  the  experiments  are  as  follows: 

1.  whether  the  new  measure,  if  used  for  the  kinematic  control,  helps  achieve 
the  desired  performance,  that  is  to  overcome  singularity; 

2.  whether  the  measure  contributes  to  preserve  the  aspect ,  the  kind  of  joint 
configurations,  and  how  preserving  the  aspect  relates  to  the  repeatability 
problem; 

3.  what  other  effects  the  transition  of  aspects  brings  about. 

To  examine  the  first  point,  the  ability  to  overcome  singularity,  simulations  for  the 
following  two  cases  are  tried:  when  the  manipulator  has  a  nearly  singular  config¬ 
uration;  and  when  the  end  effector  touches  the  base.  To  examine  the  second  and 
third  points,  on  the  other  hand,  the  end  effector  is  made  to  radially  reciprocate 
between  the  base  and  outer  limits  of  the  workspace. 

For  the  kinematic  control  in  the  experiments,  the  two  equivalent  methods,  the 
proposed  method  or  the  resolved  motion  method,  were  alternately  used  depending 
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Figure  6.2:  The  Schematic  Diagram  Of  The  Redundant 
Manipulator  With  Links  of  Equal  Length 


on  the  necessity  and  convenience  of  each  experiment. 


6.3.1  Overcoming  singularity 


The  two  experiments  examining  the  ability  of  overcoming  singularity  are  made 
with  a  manipulator  that  has  three  revolute  joints  with  the  equal  length  of  0.55m, 
as  shown  in  Figure  6.2.  In  this  case,  since  u  =  1  and  v  =  1  in  (4.3),  the  Jacobian 


matrix  becomes 


Cl23  +  C12  +  Ci  Cm  +  Cj2  C12S 


—  Si2S  ~  ■S 12  —  ■Si  — Si23  —  S12  ~ Sm 


Escaping  from  a  nearly  singular  configuration 


In  the  first  experiment,  starting  from  a  nearly  singular  configuration  of  $  = 
[-90°,  179.5°,  00]71,  the  manipulator  is  made  to  have  the  self-motion  with  each 
of  the  three  performance  measures,  and  the  respective  results  are  compared. 


Since  the  successive  change  of  configurations  —  as  time  goes  on  —  is  to  be 
examined,  the  resolved  motion  method  in  (3.6),  which  appears  the  more  suitable 
for  this  purpose  between  the  two  kinematic  control  methods,  is  used  with  a  =  10. 

Of  the  measures,  by  the  way,  in  order  to  avoid  a  large  value  of  null  space  term, 
the  condition  number  is  not  directly  minimized;  instead,  its  inverse  is  maximized. 
That  is  because  the  condition  number  has  a  large  value  at  the  initial  state,  result¬ 
ing  in  a  large  value  of  h  —  it  is  proportional  to  the  condition  number  —  which, 
in  turn,  causes  a  very  large  value  of  null  space  term. 


The  Condition  Number  Is  Used 


Figure  6.3:  The  Singularity  Avoidance  Ability  When  The  Condi¬ 
tion  Number  Is  Used:  The  Configuration  Is  Changing  Toward  The 
Optimal  Configuration  As  Time  Goes  On.  The  Link  Lengths  Are 
li  ~  I2  —  I3  =  0.55m. 

90 
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Time(sec. 


Time  Response  of  The  Manipulability 


Figure  6.4:  The  Singularity  Avoidance  Ability  When  The  Manipulability  Measure 
Is  Used:  The  Configuration  Is  Changing  Toward  The  Optimal  Configuration  As 
Time  Goes  On.  The  Link  Lengths  Are  =  Z2  =  ls  =  0.55m. 


The  result  of  the  experiment  is  given  in  Figures  6.3,  6.4,  6.5,  where  the  change 
of  configurations  and  the  time  response  of  each  measure  are  shown.  From  this 
result,  it  is  clearly  demonstrated  that  each  measure,  if  included  in  the  null  space 
term,  makes  the  manipulator  get  out  of  the  singular  configuration,  driving  joint 
values  toward  the  state  where  the  measure  has  the  maximum  value  for  the  tip 
location.  The  effect  of  including  the  performance  measures  becomes  even  more 
obvious,  if  the  self-motion  without  the  measures  is  considered,  when  no  self-motion 
happens  at  all  because  the  r.h.s  of  (3.6)  is  zero.  The  speed  of  convergence  for  the 
condition  number  case  is  noticeably  slower  than  those  of  the  two  other  measures, 
both  of  which  are  almost  the  same. 

At  the  steady  state,  whereas  the  condition  number  has  a  considerably  different 
one,  the  new  measure  and  the  manipulability  measure  have  optimal  configurations 
that  look  surprisingly  similar.  Yet  a  close  inspection  shows  that  they  are  slightly 
different.  The  reason  for  these  similar  configurations  is  as  follows.  The  optimal 
condition,  Zh  =  0,  for  each  measure  is  in  general  quite  different  from  one  another. 
Even  for  the  manipulator  in  Figure  6.2  with  such  a  particularly  symmetric  geom¬ 
etry,  joint  solutions  for  each  measure  are  different.  However,  the  above  optimal 
condition  for  each  measure  turns  out  to  be  satisfied  only  at  locations  (x,  y)  of  end 
effector  satisfying  x2  +  y2  =  l2,  with  a  particular  joint  values  of  Oj  =  0s  =  90°  or 
02  =  03  =  —90°.  Here  l  is  the  value  of  equal  length  of  the  three  links  of  given 
manipulator. 

When  passing  the  base 

Whereas  the  previous  experiment  examines  the  self-escaping  ability,  the  present 
one  examines  the  behavior  of  the  manipulator  when  the  tip  touches  the  base, 
forming  a  closed  kinematic  chain  —  a  triangle.  This  case  is  of  interest  because 
intuitively  we  see  the  self-motion  is  not  possible,  except  for  rigid  body  rotation 


of  the  triangle  with  respect  to  the  base,  as  long  as  the  tip  stays  at  that  location. 
This  intuition  can  be  easily  confirmed  if  the  projection  matrix,  I  —  J+J,  in  the 
homogeneous  solution  term  of  (3.6),  is  symbolically  derived.  To  be  more  specific, 
when  the  tip  is  located  at  the  base,  the  Jacobian  matrix  in  (3.2)  is  modified  as 
the  following  symbolic  form: 


( 0  j'u  J  is  A 
VO  j22  j'23  j 


(6.3) 


from  which  the  projection  matrix  can  be  derived  as, 


/I  0  0\ 


I  -  J+ J 


0  0  0 


(6.4) 


\0  0  0  J 

Clearly,  through  the  projection  matrix,  only  Oi  is  affected  by  the  gradient  of 
performance  measures,  h,  resulting  in  a  rigid  body  rotation  of  the  triangle  with 
respect  to  the  base,  without  making  any  other  changes  in  the  configuration. 

Then,  is  it  impossible  for  the  manipulator  to  get  into  and  out  of  the  configura¬ 
tion?  In  other  words,  can  we  obtain  the  inverse  kinematic  solution  that  resolves 
the  motion  when  the  tip  is  passing  the  base?  The  answer  for  the  question  is  that, 
although  the  homogeneous  term  becomes  ineffective  with  the  tip  at  the  base,  it 
is  still  possible  for  the  manipulator  to  get  into  and  out  of  the  point.  The  reason 
for  the  answer  may  be  analyzed  as  follows: 


•  When  the  tip  approaching  the  base,  the  homogeneous  solution  term,  al¬ 
though  diminishing,  still  exists,  continuing  the  effort  to  achieve  the  optimal 
configuration,  until  the  very  point  of  the  base. 

•  When  the  tip  getting  out  of  the  base,  on  the  other  hand,  now  that  the 
projection  matrix  is  given  as  in  (6.4),  the  homogeneous  term  does  not  con¬ 
tribute  to  overcoming  the  closed  chain  configuration.  Yet,  since  the  rank  is 
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still  preserved,  the  pseudoinverse  J+  is  available,  which  can  be  derived  from 
(3.4)  as 


J+  =  J»  -iis  (6.5) 

V  -J22  jin  / 

Since,  in  this  matrix,  the  second  and  the  third  row  vectors  are  linearly 
independent,  we  may  have  a  differential  tip  displacement  in  any  direction 
we  like  in  the  workspace. 

•  Then,  once  the  tip  is  apart  from  the  base  —  no  matter  how  small  the 
distance  may  be  —  the  homogeneous  term  immediately  begins  to  restore 
its  effectiveness. 

To  sum  up,  at  the  base,  where  the  particular  solution  term  is  still  well  defined, 
this  term  drives  the  tip  out  of  it,  while  the  homogeneous  term  is  momentarily  in¬ 
effective;  at  the  remaining  region  in  the  workspace,  on  the  other  hand,  both  terms 
are  effective.  Furthermore,  between  the  two  regions,  the  respective  transitions  of 
the  two  terms  are  smooth  without  discontinuity. 

One  may  suspects  that  the  overcoming  ability  could  have  come  from  the  inex¬ 
act  tip  location  —  the  tip  can  be  slightly  off  the  base  —  due  to  the  linearization 
characteristics  of  (3.6).  On  the  other  hand,  inexact  Jacobian  matrix  may  have 
made  it  possible  for  the  tip  to  get  out  of  the  base,  which,  with  the  exact  Jacobian 
matrix,  might  be  impossible.  But  these  are  not  the  cases,  because  both  the  Jaco¬ 
bian  matrix  in  (6.3)  and  the  pseudoinverse  in  (6.5)  are  exact  expressions  defined 
at  an  exact  point,  the  base.  Rather,  the  ability  comes  from  intrinsic  back-up 
function  of  kinematic  redundancy. 

The  aforementioned  analysis  is  well  confirmed  in  the  following  experiment. 
In  the  experiment,  the  tip  is  made  to  move  along  the  straight  line  starting  from 
x  =  [0.2, 0]T  to  [-0.2, 0]T,  passing  the  base,  [0,0]T,  with  units  in  meters.  Together 


with  the  tip  motion,  the  three  measures  are  included  in  the  inverse  kinematic 
method  proposed  in  Chapter  2,  which  was  proved  to  give  the  exact  equilibrium 
solution,  thus  excluding  the  effect  of  inaccuracy  in  both  the  tip  location  and  the 
Jacobian  matrix. 

From  the  result  shown  in  Figures  6.6,  we  see  that  with  the  three  measures  the 
manipulator  had  no  difficulty  to  treat  the  point.  We  may  conclude  that  the  use 
of  redundant  manipulator  seals  the  hole  in  the  workspace  at  the  origin,  where, 
without  the  kinematic  redundancy,  singularity  is  unavoidable. 

In  the  Figure,  one  may  note  the  smoothness  of  motion  when  the  new  measure  is 
used,  as  compared  to  motions  with  the  other  measures:  When  the  other  measures 
are  used,  the  motions  approaching  the  base  from  x  =  [0.2, 0]r  are  rather  jerky  — 
see  the  abrupt  changes  in  Si.  The  reason  for  the  smoothness  is  not  very  clear  right 
now;  but  we  can  guess  that  keeping  minors  to  be  balanced  prevents  the  abrupt 
changes  in  the  joint  angles. 

6.3.2  Preserving  the  aspect  and  its  effect  to  the  repeata¬ 
bility  problem 

In  the  following  experiment,  we  examine  whether  the  manipulator,  with  the  new 
performance  measure,  can  preserve  the  aspect  indeed,  by  comparing  to  the  cases 
with  other  measures.  The  manipulator  to  be  used  for  the  purpose  is  the  same  one 
as  used  in  the  previous  chapter:  the  three  degrees  of  freedom  planar  manipulator 
with  revolute  joints  of  l\  =  0.6,  / 2  =  0.85,  and  /s  =  0.2  with  units  in  meters. 

In  the  experiment,  the  tip  is  made  to  reciprocate  radially  between  the  base  and 
the  outer  limit,  where  the  manipulator  fully  extends.  Here,  the  tip  motion  is  so 
made,  not  because  the  radial  motion  itself  is  of  primary  concern,  but  because  it  is 
a  way  of  scanning  the  workspace  to  examine  the  ability  to  preserve  the  aspect.  To 
be  more  specific,  a  series  of  configurations  corresponding  to  the  tip  reciprocating 


in  one  radial  direction  represent,  owing  to  rotational  symmetry,  those  in  all  the 
other  directions,  thus  covering  the  whole  workspace.  Of  course,  the  rotational 
symmetry  lies  in  the  fact  that  the  new  performance  measure,  together  with  the 
other  measures,  depends  on  0^  and  0a  only,  and  is  independent  of  0\  —  hence, 
one  optimal  configuration  for  a  fixed  tip  location  is  symmetrical  to  another  for 
the  other  tip  location  of  the  same  distance  from  the  base. 

Of  the  two  kinematic  control  methods,  the  proposed  method,  being  the  more 
convenient  one  for  obtaining  the  equilibrium  states,  is  mainly  used  together  with 
the  three  measures.  When  applying  the  method,  to  solve  the  successive  joint  con¬ 
figurations  as  the  tip  reciprocates,  the  present  joint  values  are  used  as  the  initial 
conditions  for  the  next  tip  location.  The  very  first  joint  configurations  corre¬ 
sponding  to  the  starting  point  of  the  tip,  by  the  way,  are  determined  by  obtaining 
the  global  minimum.  To  do  this,  we  first  find  out,  for  comparison,  all  the  local 
minima  by  providing  with  every  possible  initial  condition  for  solving  the  system 
of  nonlinear  equations,  (2.11).  These  initial  conditions,  in  turn,  may  be  deter¬ 
mined  by  finely  tessellating  the  joint  space,  that  is,  the  domains  of  joint  variables, 
0i,  02, 03 .  In  parallel  to  this,  all  the  local  maxima  at  each  tip  location  are  obtained 
with  the  proposed  method,  in  order  to  cross-examine  if  the  successive  generations 
of  joint  values  are  indeed  correct.  In  addition  to  the  joint  configurations,  cor¬ 
responding  minor  values  are  obtained  to  examine  the  correlation  between  joint 
configurations  and  minor  values. 

Tn  Figures  6.7,  6.9,  6.11,  the  optimal  joint  configurations  based  on  each  of  the 
performance  measures  and  the  value  of  each  measure  are  plotted. 

Corresponding  minor  values  are  plotted  in  Figures  6.8,  6.10,  6.12. 

As  shown  in  the  figures,  each  performance  measure  has  two  distinct  sets  of 
configurations  that,  depending  on  the  tip  location,  alternately  give  the  global  op¬ 
timum.  Hence,  each  of  the  two  sets  of  configurations  has  its  own  corresponding 


performance  measure  curve:  the  one,  consisting  of  mostly  the  ladder-shaped  con¬ 
figurations,  corresponds  to  the  curve  with  a  solid  line;  and  the  other,  consisting 
of  mostly  ‘N’-shaped  configurations,  to  the  curve  with  a  broken  line.  For  conve¬ 
nience,  let  us  denote  the  former  configurations  A,  and  the  latter  configurations 
B. 

Besides,  note  that  the  mirror-image  sets  of  Configurations  A  and  B  with  re¬ 
spect  to  the  x-axis,  although  having  the  same  values  of  the  corresponding  measure, 
are  not  included  in  the  figures,  for  brevity.  Of  course,  there  are  still  additional  sets 
of  configurations  that,  corresponding  to  local  maxima  instead  of  global  maxima, 
are  not  shown  in  the  figures  either. 

What  do  we  find  from  the  resulting  configurations?  Let  us  examine  the  con¬ 
figurations  generated  by  each  performance  measure  one  after  another. 

The  Manipulability  Measure 

Figure  6.7  shows  the  two  configurations  and  corresponding  values  of  performance 
measure,  when  the  manipulability  measure  is  used.  In  the  figure,  depending  on  the 
tip  location,  each  of  the  two  configurations  alternately  assumes  larger  performance 
measure  value  than  the  other.  In  the  region  between  i  =  1.1m  and  z  =  1.6m, 
however,  the  two  configurations  become  identical,  having  the  same  performance 
measure  values.  Then  what  happens  with  the  two  configurations,  when  the  tip  is 
coming  out  of  this  region  of  the  identical  configuration?  To  answer  this  question, 
we  need  more  careful  observations  as  follows. 

In  Configurations  A,  the  initial  configuration  is  preserved  within  almost  the 
whole  workspace  except  for  the  region  between  the  base  and  x  =  0.1m.  That  is, 
except  for  this  region,  the  initial  shape  does  not  change,  regardless  of  wherever 
the  tip  location  may  be,  and  to  whatever  direction  —  toward  or  outward  from 


In  Configuration  B,  on  the  other  hand,  where  the  tip  starts  from  near  the  base, 
the  initial  configuration  is  preserved  only  if  the  tip  is  located  within  a  certain  dis¬ 
tance  from  the  base,  about  1  m;  outside  the  location,  the  configurations  shift  or 
merge  into  Configuration  A.  And  once  merged,  configurations  corresponding  to 
subsequent  tip  motions  stay  within  Configuration  A,  never  returning  to  Configu¬ 
ration  B. 

Here,  we  observe  that  the  manipulator  has  switched  the  aspect  or  the  kind 
of  joint  solutions.  Moreover  the  configuration,  once  switched  from  one  aspect 
to  another,  does  not  return  to  the  initial  configuration:  the  expected  repeatabil¬ 
ity  problem.  Then,  what  happened  to  the  minors  when  this  switching  of  aspect 
occurred?  Did  they  change  their  sign  indeed,  passing  through  zero  values?  Fig¬ 
ure  6.8  clearly  shows  that  is  the  case:  the  tip  location  where  merging  happens  is 
the  place  where  one  of  the  minors  changes  its  sign. 

The  Condition  Number 

In  the  case  of  the  condition  number,  the  situation  is  even  more  complicated. 
In  this  case,  Configurations  A  consists  of  successive  joint  configurations,  where 
the  tip  starts  from  near  outer  limit  of  the  workspace  toward  the  base,  whereas 
Configuration  B  represents  the  movements  in  the  opposite  direction  from  the 
base.  Differently  from  the  manipulability  case,  in  both  Configurations  A  and  B, 
the  initial  configurations  are  merged  into  the  other.  Furthermore,  the  locations 
where  mergings  occur  are  different:  about  z  =  0.7 m  for  Configuration  A;  and 
x  =  1.3m  for  Configuration  B.  And  within  x  =  0.7m  or  outer  than  z  =  1.3m,  the 
two  configurations  are  identical,  giving  the  same  measure  curve. 

Hence,  the  repeatability  problem  occurs,  between  z  =  0.7m  and  z  =  1.3m, 
when  the  tip  reverses  its  direction  after  experiencing  a  merging.  Again,  the  mi¬ 
nor  curve  in  Figure  6.10  shows  that,  when  the  switchings  occur,  signs  of  minors 


change. 


<,»l 


.» 

*>» 

ft 


■ill 


ss 


1 


v.l 


a 


, 

»• 

;v 

;> 


8 


1 


V 

V 
•»» 


1 


V' 


:S 

*4  '* 

h 


The  New  Measure 


When  the  new  performance  measure  is  used,  there  still  exist  two  distinct  config¬ 
urations.  One  thing  particularly  noticeable  is  that  there  is  no  switching  for  both 
configurations;  there  is  no  repeatability  problem  at  all.  Because  of  no  merging 
effects,  the  initial  configurations  are  distinctly  preserved  showing  also  distinct 
measure  curves.  As  expected,  the  minor  curve  in  Figure  6.12  clearly  shows  that 
there  is  no  sign  change  at  all  for  the  three  minors.  We  see  from  this  an  obvious 
consequence  of  using  a  measure  that  has  a  direct  control  over  each  minor  value; 
the  property  mentioned  in  Section  5.5  has  an  immediate  effect. 

Besides,  we  can  observe,  as  compared  to  cases  with  the  other  measures, 
smoother  movements  near  base,  which  remind  us  of  the  previous  experiment 
results  when  passing  the  base. 


6.3.3  Discontinuity  effects 


As  mentioned  in  Section  5.5,  when  merging  of  configurations  or  switching  of 
aspects  occur,  discontinuous  joint  motion  was  predicted. 

To  confirm  the  prediction,  we  obtained  joint  velocities  of  both  configurations 
for  each  measure.  Here  the  tip  is  made  to  move  with  a  constant  velocity  of 
0.1  (m/sec).  To  resolve  the  velocity,  we  used  the  Resolved  Motion  Method. 


Figure  6.13,  6.14,  6.15  show  the  resulting  velocity  curve  corresponding  to 
the  configurations  obtained  in  the  previous  subsection.  As  expected,  the  two 
configurations  of  the  new  measure  and  Configuration  A  of  the  manipulability 
measure,  where  there  is  no  switching,  show  quite  smooth  joint  velocity  trajectories 
as  plotted  in  Figures  6.13  and  6.15. 


For  the  remaining  cases,  where  switchings  occur,  the  velocity  trajectory  is  gen¬ 
erally  rugged,  confirming  our  prediction.  Yet,  the  degrees  of  ruggedness  for  the 
two  measures  are  different.  A  careful  observation  reveals  the  following:  for  the 
manipulability  measure,  the  merging  happens  through  some  intermediate  config¬ 
urations,  reducing  the  degree  of  discontinuity;  whereas,  for  the  condition  number, 
the  switching  happens  instantaneously  with  few  intermediate  states,  resulting  in 
much  larger  values  of  joint  velocity. 

It  is  not  very  clear  right  now  why  this  difference  exists.  We  will  probably 
be  able  to  get  some  clue,  if  the  gradients  of  the  two  measure  are  first  expressed 
in  symbolic  forms  and  then  each  term  is  examined  to  pinpoint  the  cause  of  the 
abrupt  switching.  To  have  the  symbolic  expressions  for  this  inspection  appears 
to  be  possible,  although  quite  complicated,  in  this  particular  manipulator  case. 


6.4  Conclusion 


Summing  up,  the  new  measure  has  been  compared  with  the  two  other  measures, 
both  qualitatively  and  quantitatively.  The  result  of  analysis  on  qualitative  rela¬ 
tionship  agrees  well  with  the  experimental  results. 

To  summarize  these  results,  all  the  measures  showed  the  ability  to  overcome 
singularity  by  successfully  treating  the  two  locations:  the  location  corresponding 
to  almost  straight  line  configuration  and  the  base  or  the  origin.  The  essential 
difference  between  the  new  measure  and  the  other  ones  is  its  ability  to  explicitly 
prevent  the  minors  from  becoming  zero.  This  ability  in  effect  prevents  the  merging 
of  configurations  and  switching  of  aspects,  which  in  turn  enable  to  prevent  the 
repeatability  problem  and  impulsive  motions.  In  addition,  the  extra  care,  built 
in  the  new  measure,  about  the  balanced  values  of  minors  appears  to  contribute 
to  noticeably  smooth  movements  near  the  base. 
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Time  Response  of  The  New  Measure 


Figure  6.5:  The  Singularity  Avoidance  Ability  When  The  New  Measure  Is  Used: 
The  Configuration  Is  Changing  Toward  The  Optimal  Configuration  As  Time  Goes 
On.  The  Link  Lengths  Are  lt  =  l3  =  ls  =  0.55m. 
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The  Condition  Number  Is  Used 


The  Manipulability  is  Used 


The  New  Measure  Is  Used 


Figure  6.6:  Use  Of  The  Three  Performance  Measures,  When  The  Tip  is  Pass¬ 
ing  The  Base  From  x  =  0.2  to  x  =  -0.2  On  The  x-axis,  With  Link  Lengths, 
(l  =  i2  =  l3  =  o.55m  102 
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The  Manipulability  Is  Used  In  Configuration  A 
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The  manipulability  Is  Used  In  Configuration  B 


The  Manipulability 


—  Configuration  A 
-  Configuration  B 


Tip  Location  X(m) 


Figure  6.7:  Configurations  A  And  B,  When  The  Manipulability  is  Used  As  Perfor¬ 
mance  Measure,  And  Corresponding  Values  of  The  Measure,  Where  A  And  B  Refer 
To  The  Tip-Motion  With  Different  Initial  Configurations. 
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Minors  For  Configuration  B 

Figure  6.8:  The  Minor  Values  In  Configurations  A  And  B,  When  The  Manipulability 
is  Used  As  Performance  Measure,  Where  A  And  B  Refer  To  The  Tip-Motion  With 
Different  Initial  Configuration. 
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Minors  For  Configuration  B 

Figure  6.10:  The  Minor  Values  In  Configurations  A  And  B,  When  The  Condi¬ 
tion  Number  is  Used  As  Performance  Measure,  Where  A  And  B  Refer  To  The 
Tip-Motion  With  Different  Initial  Tip  Location. 
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Joint  Velocities  With  The  Condition  Number:  Configuration  A 
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Tip  Location  X(m) 

Joint  Velocities  With  The  Condition  Number:  Configuration  B 

Figure  6.14:  The  Joint  Velocities  In  Configurations  A  And  B,  When  The  Con¬ 
dition  Number  is  Used  As  Performance  Measure,  Where  A  And  B  Refer  To  The 

Tip-Motion  With  Different  Initial  Configurations. 
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Chapter  7 


Conclusion 


In  this  thesis,  some  important  aspects  of  kinematic  control  problems  have  been 
investigated.  These  aspects  may  be  categorized  into  two  main  themes:  One  is  the 
formulation  of  a  new  general  the  inverse  kinematic  method  for  redundant  arms. 
The  other  is  the  development  of  a  new  dexterity  measure. 

Finding  a  concise  yet  general  formulation  is  important  for  the  exploitation  of 
kinematic  redundancy.  Furthermore,  the  fact  that  the  equation  is  formulated  at 
the  inverse  kinematic  level  is  significant  because  it  has  the  advantage  of  directly 
mapping  from  workspace  to  joint  space.  The  relationship  between  the  new  formu¬ 
lation  and  existing  ones  such  as  the  Resolved  Motion  Method  has  been  analyzed. 

Among  various  desired  performances,  the  dexterous  configurations  are  not 
yet  well  understood.  By  explicitly  defining  the  dexterity  as  the  distance  from 
the  kinematic  singularity,  one  can  have  a  good  springboard  for  approaching  this 
rather  ambiguous  concept.  This  distance  concept  in  fact  helps  illuminate  the 
less  known  fact  that  for  a  particular  degree  of  redundancy  there  are  different 
degrees  of  distance  from  singularity.  This  finding  in  turn  immediately  leads  to  a 
performance  measure  for  controlling  this  distance.  An  analysis  of  the  relationship 
of  the  new  measure  with  similar  measures  confirms  that  our  approach  is  sound 


and  useful. 

In  the  light  of  these  two  themes,  each  chapter  is  reviewed  as  follows.  Chapter 
2  covers  the  derivation  of  the  proposed  formula,  the  interpretation  of  its  charac¬ 
teristics,  and  estimation  of  computational  efficiency.  In  addition,  the  new  formula 
was  there  compared  to  the  existing  formula  and  it  is  shown  that  the  new  formula 
is  a  general,  yet  concrete  expression  of  the  others. 

In  Chapter  3,  we  qualitatively  compared  this  formula  with  the  Resolved  Mo¬ 
tion  Method.  From  the  comparison  we  analytically  showed  that  the  proposed 
formula  is  in  fact  a  direct  mapping  counterpart  of  the  other  method.  That  is, 
the  proposed  formula  was  proved  to  provide  directly  the  equilibrium  states  at 
which  the  joint  variables  in  the  other  method  eventually  arrive  if  the  end  effec¬ 
tor  is  made  to  stop  at  a  fixed  location.  In  addition,  Resolved  Motion  Method 
was  shown  to  lead  to  non-repeatable  behavior.  We  also  proposed  a  differential 
relationship,  equivalent  to  the  other  method,  yet  based  on  the  proposed  formula, 
which  is  shown  to  be  slightly  more  efficient. 

In  Chapter  4,  numerical  experiments  were  made  to  verify  the  theoretical  and 
qualitative  results  so  far  obtained.  Also  the  numerical  efficiency  of  the  new 
method  was  compared  with  the  Resolved  Motion  Method.  The  theoretical  re¬ 
sults  confirmed  through  the  simulations  were  as  the  following: 

•  the  Resolved  Motion  Method  is  a  linearized  equation  approximated  at  the 
equilibrium  points  that  are  exactly  determined  by  the  proposed  formula: 

•  the  repeatability  problem  persists  in  the  Resolved  Motion  Method  in  tran¬ 
sient  period  as  well  as  at  the  steady  states. 

In  addition,  a  practical  way  to  use  the  proposed  formula  in  a  real  time  control  sit¬ 
uation  was  considered  in  conjunction  with  an  efficient  joint  interpolation  method 
devised  by  Taylor.  Th*  comparison  of  efficiency  with  the  other  method  sh"”® 
that  the  proposed  formula  is  more  efficient  when  higher  accuracy  is  required. 
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In  Chapter  5,  we  have  defined  the  concept  of  dexterity  as  a  distance  from 
singularity.  Then  we  reviewed  the  concept  of  singularity  and  redundancy  for 
further  investigation  of  the  distance  concept.  We  have  illustrated  that  there  are 
different  degrees  of  distance  from  singularity  in  the  same  degree  of  redundancy, 
showing  that  the  conventional  concept  of  redundancy  is  not  sufficient  to  describe 
this  distance.  The  new  distance  concept  we  derived  was  the  number  of  nonzero 
minors  as  well  as  the  magnitude  of  each  minor.  On  the  bas's  of  the  new  concept, 
a  new  performance  measure  was  derived. 

In  Chapter  6,  we  have  related  the  new  performance  measure  with  the  manip- 
ulability  measure  and  the  condition  number.  Having  investigated  the  qualitative 
relationship,  we  pointed  out  that  the  other  measures  do  not  have  the  ability  to 
explicitly  prevent  minors  from  becoming  zero.  Through  another  series  of  nu¬ 
merical  experiments,  the  effect  of  this  ability  was  clearly  confirmed.  Whereas 
the  two  other  measures  without  this  ability  showed  repeatability  problem  and 
discontinuous  motions,  the  new  measure  consistently  overcame  these  problems. 


Appendices 


Appendix  1:  Taylor’s  Bounded  Deviation  Algo¬ 
rithm 

In  this  Appendix,  we  briefly  introduce  Taylor’s  bounded  deviation  algorithm.  The 
algorithm  consists  of  two  parts:  one  part  is  to  generate  appropriate  numbers  of 
via  points  and  joint  angles  that  guarantee  given  deviation  from  Cartesian  path; 
the  other  part  interpolates  the  joint  angles  to  obtain  better  resolution.  The  first 
part  is  summarized  in  the  following  scheme. 

Taylor’s  Bounded  Deviation  Joint  Paths 

1 .  Compute  the  joint  values  90  and  9 1 ,  corresponding  to  Xo  and  Xi ,  respectively. 

2.  •  Compute  the  joint  space  midpoint,  9m  =  +  #i)/2,  and  use  it  to 

compute  fm  =  f(0m). 

•  Also,  compute  the  workspace  midpoint,  xm  =  (xo  +  Xi)/2 

3.  Compute  the  deviation  between  fm  and  xm,  6  =  |xm  -  fm| 

4.  If  6  <  6maz ,  we  are  done.  Otherwise,  compute  the  joint  value  9X  =  f-’fxm); 
and  apply  steps  2 — 4  recursively,  for  the  two  segments  (xo  — *  xm)  and 
(xm  —  x,). 
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Here,  the  deviation  may  be  defined  as  a  Euclidean  norm  of  position  errors 
from  the  desire  path.  Once  the  generation  of  via  point  is  complete,  then  the  joint 
angles  obtained  in  the  process  of  executing  the  scheme  is  now  used  to  generate 
more  intermediate  joint  angles  by  interpolation  methods.  When  applying  the  in¬ 
terpolation  methods,  if  the  tip  is  off  the  ends  of  line  segments  determined  by  via 
points,  linear  interpolation  is  used.  At  the  transition  area  from  one  line  segments 
to  another,  on  the  other  hand,  the  quadratic  interpolation  is  used  for  smooth 
transitions.  This  interpolation  strategy  is  implies  that  the  joint  velocity  is  con¬ 
stant  at  off  the  transition  area,  whereas  near  the  transition  the  joint  acceleration 


made  constant. 


Appendix  2:  The  Derivation  of  The  Extended  Ja¬ 


cobian  Method 


In  this  Appendix,  we  will  prove  that  (2.10)  reduces  to  the  extended  Jacobian 
method,  when  n  =  m  -f  1. 

The  additional  equation  to  resolve  the  redundancy  in  the  extended  Jacobian 
method  is  given  (Baillieul,1985)  in  (2.22)  and  (2.23)  as 


G{0)  -  nyh 

=  0 


(A.l) 


where 


xij  =  (Aj,  A*, ...,  A„) 

A,  =  (-1  )'+'det(J\J\..J'\J'+\..,Jn) 


and  where  Jk  is  the  Ar-th  column  vector  of  the  Jacobian  matrix,  J,  derived  from 
(2.1).  When  n  =  m  +  1,  our  result,  (2.10),  is  specified  as 


G2(*)  =  [(J")rJm-\-l]h 

=  0 


(A.2) 


where  (Jn)T  is  the  transpose  of  the  n-th  column  vector  of  the  Jacobian  matrix, 
J.  Jm_1  can  be  derived  as 

Jm“'  -  Am  (A. 3) 
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where  Am  is  the  adjoint  matrix  of  Jm  and  Dm  is  the  determinant  of  Jm.  Thus 
Am  is  expressed  as 
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where  A'  is  the  i-th  column  vector  of  Am.  Since 


( Jn)T  Alm  —  j\nCof\\  +  jinC  of  12  +  ..  +  jmnCofu 

=  -A, 


we  get  likewise 


{Jn)TA'm  =  -A, 

From  the  definition  of  An,  we  get 

An  =det(JmT) 

= 


Therefore, 


=  . -i) 


(A.6) 


(A.7) 


(A.8) 


Since  Jm  is  nonsingular  —  and  thus  An  is  nonzero,  we  can  multiply  by  it  on  both 
sides  of  (A. 2),  resulting  in  (2.22).  Thus  we  have  proved  that  (2.10)  is  a  general 
expression  which  yields  the  additional  equation  in  the  extended  Jacobian  method. 


Appendix  3:  The  Relationship  with  Resolved  Mo¬ 
tion  Method  At  Equilibrium  State 

From  Lemmas  1  and  2,  it  was  shown  that  column  vectors  of  ZT  are  a  set  of  basis 
vectors  which  are  orthogonal  to  J.  Thus,  row  vectors  of  J,  together  with  column 
vectors  of  ZT  constitute  the  basis  of  n-dimensional  vector  space. 


Accordingly,  any  n-dimensiona!  vector  h  can  be  represented  as 


h  =  JTh,  +  ZTh2  (A.9) 

where  hi  and  hi  are  arbitrary  vectors  of  m  and  n  -  m  dimensions,  respectively. 
Premultiplying  (A.9)  by  J,  we  have 

Jh  =  JJTh| 


Thus, 


h,  -  (JJT)~'Jh 


(A.  10) 


Similarly,  if  we  multiply  (A.9)  with  Z  and  solve  for  I12,  we  get 


h2  =  (ZZT)-‘Zh 


(A. 11) 


From  (A.9)  to  (A. 11),  we  obtain  the  following  relationship: 

(I  JT(JJT)-*J)h  =  ZT(ZZT)-'Zh 

or,  from  (3.5), 

(I  -  J+J)h  =  Zr(ZZT)'*Zh  (A. 12) 

For  a  constant  location  of  the  end  effector  (no  tip  motion),  when  dx  -  0,  (3.6), 
with  (A.  12),  becomes 

d»  =  Zr(ZZT)"lZh  (A. 13) 

If  Zh  -  0  as  in  (2.10),  then  from  (A. 13),  dO  =  0,  which  means  that  joint  variables 
reach  an  equilibrium  state  —  or  a  stationary  state  —  which  is  mostly  the  optimal 
configuration  for  a  given  tip  location.  Conversely,  if  d$  —  0,  we  have  Zh  =  0; 
since  the  rank  of  ZT(ZZT)_1  in  (A. 13)  is  n  -  m  and  Zh  is  an  (n  -  m)-dimensional 
vector. 

Therefore,  Zh  =  0,  (2.10),  of  the  proposed  method  is  the  necessary  and  suffi¬ 
cient  condition  to  be  satisfied  when  (3.6)  of  RM  method  reaches  its  equilibrium 


Appendix  4:  Proof  of  Theorem  3 


In  this  appendix,  we  make  a  proof  of  Theorem  3.  The  Jacobian  matrix  is  expressed 
as  the  following: 

/  in  •  •  •  Jin  \ 


J  = 


Then 


V  Jml  '  #  *  Jmn  J 


(  £L,i»*5 


JJ5 


I  JlkJmk  \ 


Jmkjlk  "■  =  i  Jmk  J 

In  general,  the  determinant  of  an  m  x  m  matrix  A  is  explicitly  given  as 


det(A)  =  X](ai«a2/?  '  ’  ‘  amu)det(Pa)  (A. 14) 

a 

where  atJ  is  the  element  of  A  at  t-th  row  and  j-th  column,  a  =  (a,  /?,  •  •  • ,  u)  with 
distinct  integers,  =  1,2 Pg  is  the  permutation  matrix,  and 

}2a  means  the  sum  is  taken  all  m!  permutations  of  o.  Hence,  the  determinant  of 
JJT  is 


det(JJT)  =  £(£  jikjak)(YL  jnjpk)  •  •  •  (£  Jmkjuk)det(Pg) 
a  *=i  *=i  *=i 

Expanding  this,  we  have 

n 

det(  JJT)  =  ]T(  Y,  jikjakjikjp^,--- Jmk,JvkM)det(Pa)  (A. 15) 

a  ,*,„  =  « 

Here,  note  that  terms  that  have  non-distinct  fc.’s  disappears.  For  instance,  if 
k-i  =  k i  ~  1,  then  jujaijiijffv  ■  ■  •  Jmmjvm  disappears  when  a  =  1  and  (3  2. 
Thus,  in  Equation  A. 15,  summation  is  applied  only  to  the  terms  with  distinct 
k,' s.  Note  also  that  the  number,  p,  of  different  sets  of  distinct  k,' s  is 

p  =  nCm. 

Rearranging  Equation  A. 15,  we  have 

n 

de‘{  33  )  ~  JlkJtk,  •  •  •  I  Jmkdct  (  Pa)  )  (jakJlli,!  ’  i  JmkJvk ) 


Here  summation  ££  t>  may  be  divided  into 

n  P 

E  =  EE 

*1 .  -  1  I- 1  O , 

where  a,  —  {kt,  k?,  •  •  ■ ,  km)  is  i-th  set  of  p  different  sets  consisting  of  m  distinct 
k, ’s .  Therefore  Equation  A.  15  becomes 

p 

det( JJr)  =  £  Z(E  • '  •  -  imt.,  (A. 16) 

1-1  0,0 

If  we  denote  a  part  of  Equation  A. 16  as 

A,  =  52jakj0kl,--Jvk„,det{Pa) 

a 

Comparing  this  with  Equation  A.  14  shows  that  A,  is  the  determinant  of  the 
transpose  of  the  submatrix  made  of  kt' s  column  vectors  as 

A,  =  det([Jkt  Jk--Jk~  )T) 

where  Jk‘  is  the  k,- th  column  vector  of  the  Jacobian  matrix.  Once  a  set  of  kt's 
is  chosen,  the  absolute  value  of  A i  is  fixed;  only  its  sign  changes  as  Ar.’s  make 
permutations.  If  we  set  the  absolute  value  as  |A,|,  Equation  A. 16  becomes 

det(JJT)  ---  ^(±)!A,|  (52jikJtk2,  --Jmk„,det(Pa,)) 

,  =  1  o, 

The  facts  that  the  determinant  of  a  matrix  is  equal  to  that  of  transpose  of  the 
matrix  and  that  JJT  is  positive  definite  imply  that 

de<(JJr)  =  £  A,2. 


Appendix  5:  Proof  for  Derivation  of  Joint  Veloc¬ 
ity  from  the  Optimizing  Equation 

Since  Z  spans  the  null  space  of  j,  we  have 

ZJT  =  0  (A. 17) 

Hence,  multiplying  both  sides  of  (A. 17)  by  (JJT)_1,  we  have 

ZJT{JJT)-!  =  0  (A. 18) 

Using  the  relationship,  J+  —  ZJT(JJT)~1,  we  derive  from  (A.  18) 

ZJ+  =  0 


Meanwhile  the  definition  of  the  pseudoinverse  matrix  is  again, 


JJ+  =  lm 


where  Im  is  the  identity  matrix  of  rank  m.  Combining  the  above  two  equations 
results  in  a  composite  equation, 


J 

Z 


(A.19) 


where  the  composite  matrix  is  denoted  as 


Multiplying  both  sides  of  (A.19)  by  J£‘  results  in 


(A. 20) 


(A-21) 


Q.E.D. 
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